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异 可 


近年 来 ,工业 机 器 人 在 制造 业 领域 的 应 用 如 火 如 茜 ,工业 机 器 人 是 智能 制造 的 核心 技 
术 。 本 书 从 实用 的 角度 出 发 ,对 工业 机 器 人 的 选 型 .系统 集成 .实用 配 线 、 特 殊 功 能 、 编 程 语 

言 、 状 态 变量 .参数 功能 及 设置 .工业 机 器 人 与 PLC 触摸 屏 的 综合 应 用 、 工 业 机 器 人 与 视觉 
系统 的 综合 应 应 用 等 方面 做 了 深入 浅 出 的 介绍 ,提供 了 大 量 的 程序 指令 解说 案例 。 

本 书 根据 实际 的 应 用 成 果 ,介绍 了 工业 机 器 人 在 抛光 测量 分 拣 、 码 才 、 视 觉 追踪 等 方面 
的 应 用 。 这 些 应 用 是 实际 工作 的 总 结 ,可 以 给 机 器 人 的 设计 、 集 成 ,编程 .调试 人 员 以 实用 的 
参考 ,也 可 以 使 高 校 学 生 在 学 习 一 定 的 基础 知识 后 ,了 解 如 何在 实际 的 项 目 中 配置 和 设计 机 
器 人 集成 项 目 , 建 造 从 学 校 到 实际 应 用 的 一 条 快速 走廊 。 

本 书 以 新 颖 的 编排 形式 ,遵循 "由浅 和 人 深交 由 少 到 多 ”的 原则 , 按 30 个 工作 日 ,分 步 对 工 
业 机 器 人 的 知识 进行 实用 性 的 介绍 ,解决 了 初学 者 面 对 茫 茫 资料 不 知 所 措 的 问题 。 本 书 以 
一 种 品牌 的 机 器 人 为 主 进行 系统 的 学 习 。 经 过 系统 的 学 习 之 后 ,读者 就 可 以 上 手 做 工程 项 
目 ,所 以 本 书 不 是 泛泛 而 谈 的 科普 性 书籍 。 

本 书 第 1 一 19 章 是 工业 机 器 人 的 基础 理论 介绍 ,主要 介绍 机 器 人 的 选 型 . 配 线 、 编 程 指 
令 ,状态 变量 、 函 数 , 参 数 功能 及 设置 。 本 书 从 最 实用 的 角度 来 介绍 如 何 选 型 ,各 技术 指标 的 
含义 ,以 及 如 何 配 线 。 在 第 3 章 就 指导 读者 让 机 器 人 动 起 来 ,消除 工业 机 器 人 的 神秘 感 。 

本 书 对 机 器 人 编程 指令 进行 了 详细 讲解 。 经 过 对 编程 指令 由 浅 人 深 的 学 习 , 读 者 可 以 
牢固 地 掌握 这 些 指令 。 在 第 16 一 18 章 “ 参 数 功能 及 设置 ”中 ,结合 软件 的 使 用 对 重点 参数 的 
功能 及 设置 做 了 说 明 。 这 也 是 从 使 用 者 的 角度 着 想 的 。 

从 第 20 章 开 始 ,介绍 工业 机 器 人 在 实际 工程 项 目 中 的 应 用 , 且 每 章 介 绍 一 个 工程 项 目 。 
重点 介绍 面 对 客 户 的 要 求 , 如 何 提出 解决 方案 ,如 何 配置 系统 硬件 ,如 何 宏观 地 分 析 工 作 流 
程 和 绘制 工作 流程 图 ,如 何 编制 机 器 人 的 相关 程序 。 本 书 提供 的 应 用 案例 将 对 工程 技术 人 
员 有 很 大 的 帮助 。 

本 书 第 26 一 29 章 介绍 了 机 器 人 视觉 追踪 的 理论 .指令 应 用 、 参 数 设 置 和 编程 实例 ,这 是 
机 器 人 应 用 比较 高 端的 部 分 。 

申 建 北 、 胡 彬 、 辛 曼 一 、 吴 建 发 . 杨 桂 珍 、 胡 伟 、 刘 勇 、 黄 纯 、 付 芬 等 参加 了 本 书 的 编写 。 

感谢 林 步 东 对 本 书 提供 的 大 量 支持 。 

由 于 作者 学 识 有 限 , 书 中 不 免 有 足 漏 和 不 足 之 处 ,希望 读者 提出 批评 建议 ,与 作者 进行 
交流 。 


黄 风 
2018 年 11 月 
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第 1 童 第 1 日 一 一 工业 机 器 人 的 
人 构成 和 技术 指标 


【学 习 目的 】 

在 第 1 日 的 学 习 中 ,要 学 习 关 于 工业 机 器 人 的 最 基本 的 知识 ,学习 工业 机 器 人 的 技术 规 
格 以 及 相关 的 性 能 指标 。 这 是 因为 在 使 用 工业 机 器 人 时 最 初 遇 到 的 就 是 选 型 问题 , 即 客户 
提出 要 求 ,我 们 应 该 如 何 为 客户 的 项 目 选 型 ? 选 型 中 最 重要 的 技术 指标 是 什么 ? 这 些 技术 
指标 的 含义 是 什么 ? 


1.1 什么 是 工业 机 器 人 


工业 机 器 人 实质 上 是 一 套 由 运动 控制 器 控制 ,可 以 实现 多 轴 联 动 的 多 关节 型 工业 
机 械 。 

我 们 通常 看 到 的 数控 机 床 也 是 由 运动 控制 器 控制 的 工业 机 械 ,但 是 机 器 人 与 数控 机 床 
的 区 别 是 机 器 人 是 多 关节 型 工业 机 械 (模仿 人 类 动作 ) ,而 且 机 器 人 一 般 可 以 做 到 6 轴 联 动 ， 
而 数控 机 床 大 部 分 是 3 轴 联 动 。 


1.2 工业 机 器 人 的 构成 


工业 机 器 人 由 以 下 几 个 主要 部 分 构成 ,如 图 1-1 所 示 。 


1. 机 器 人 本 体 

本 体 包 含 机 械 构件 (各 关节 工作 臂 以 及 减速 机 ) 和 伺服 电机 。 伺 服 电机 已 经 安装 在 机 械 
本 体 上 。 

2. 控制 器 

控制 器 包括 控制 CPU、 伺 服 驱动 器 .基本 1/O、 各 种 通信 接口 (USB/ 以 太 网 )。 

3. 示 教 单元 

示 教 单元 也 称 为 “手持 操作 器 ”, 简 称 TB, 用 于 手动 操作 机 器 人 运行 ,确定 各 工作 点 、 
JOG 运行 .设置 参数 .设置 原点 .显示 机 器 人 工作 状态 。 

4. 附件 


附件 包括 抓 手 和 各 种 接口 板 。 
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图 1- 


机 器 人 控制 器 


| vo 模块 及 电 统 


(Vo 卡 及 电 织 


1 工业 机 器 人 系统 构成 简 图 


1.3 工业 机 器 人 技术 规格 


垂直 多 功能 机 器 人 技术 规格 


输入 输出 卡 
等 附件 


如 表 1-1 所 示 为 垂直 多 功能 机 器 人 技术 规格 。 在 该 技术 规格 中 ,标明 了 伺服 电机 容量 、 
动作 范围 .最 大 合成 速度 .搬运 重量 ,这些 都 是 机 器 人 选 型 的 重要 依据 。 


表 1-1 垂直 多 功能 机 器 人 技术 规格 


攻 规 格 
单位 RV-4F RV-4FL RV-7F RV-7FL 

环境 规格 未 标注 : 一 般 ; C: 清 洁 ; M: 油 雾 
动作 自由 度 6 6 6 6 
安装 方式 落地 ,吊顶 、 挂 壁 
结构 垂直 多 关节 
驱动 方式 AC 伺服 电机 / 带 全 部 轴 制 动 
位 置 检测 方式 绝对 值 编码 器 

本 400 750 

中 400 750 

J3 100 400 
电机 容重 J4 w 100 100 

J5 100 100 

J6 50 50 


续 表 


型 号 单位 规 格 
本 480 
J2 240 —115~125 | —110~130 
< - J3 0 一 161 0 一 164 0 一 156 0 一 162 
动作 邦 园 J4 dy 士 200 士 200 士 200 士 200 
5 土 120 
J6 士 360 
本 450 420 360 288 
J2 450 336 401 321 
J3 300 250 450 360 
最 大 速度 J deg/s Ba rE 
J5 623 450 
J6 720 
最 大 动作 半径 mm 514.5 648.7 713.4 907.7 
最 大 合成 速度 mm/s 9000 11 000 
搬运 重量 kg 4 4 7 和 
位 置 重复 精度 mm 主 0.02 
循环 时 间 s 0.36 0.32 0.35 
环境 温度 © 0~40 
本 体重 量 kg 39 41 65 67 
J4 6.66 16.2 
允许 力矩 J5 m 6.66 16.2 
J6 3.90 6. 86 
J4 0. 20 0. 45 
允许 惯量 J5 kg。m? 0.20 0.45 
J6 0.10 


1.3.2 水 平 多 功能 机 器 人 技术 规格 


如 表 1-2 所 示 为 水 平 多 功能 机 器 人 技术 规格 。 在 该 技术 规格 中 ,标明 了 臂 长 ,动作 范 
围 . 最 大 合成 速度 、 搬 运 重量 \ 位 置 重复 精度 ,这 些 都 是 机 器 人 选 型 的 重要 依据 。 水 平 多 功能 


机 器 人 多 用 于 平面 搬运 和 垂直 搬运 。 
表 1-2 水 平 多 功能 机 器 人 技术 规格 
规 格 
人 尘 位 RH-6FH35 ** /M/C| RH-6FH45 ** /M/C| RH-6FH55 *x /M/C 
环境 规格 未 标注 : 一 般 ; C: 清 洁 ; M: 油 雾 
动作 自由 度 4 4 4 
安装 方式 落地 
结构 水 平 多 关节 
驱动 方式 AC 伺服 电机 
位 置 检测 方式 绝对 值 编码 器 


击 一 淹 
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续 表 
型 号 单位 规 格 
NO1 臂 长 125 225 325 
225 
100 400 
和 长 NO2 臂 长 En 100 100 
100 100 
50 50 
本 340 
J2 i 290 
本 J3 mm x# 一 20: 200 x*#* 二 34: 340 
J4 deg 720 
本 dg/ 400 
J2 670 
时 大 速度 J3 mm/s 2400 
J4 deg/s 2500 
最 大 动作 半径 mm 350 450 550 
最 大 合成 速度 mm/s 6900 7600 8300 
搬运 重量 kg 最 大 6( 额 定 3) 
位 置 重 复 精度 mm 士 0.010 
循环 时 间 s 0.29 
环境 温度 C 0~40 
本 体重 量 kg 36 36 37 
允许 惯量 额定 er 0.01 
最 大 0.12 
1.4 对 工业 机 器 人 主要 技术 指标 的 解释 
1.4.1 机 器 人 部 分 技术 规格 名 词 术语 
(1) 安装 位 置 : 机 器 人 的 可 安装 方式 ,如 落地 .吊顶 、 挂 壁 。 
(2) 驱动 方式 : 机 器 人 各 轴 的 动力 源 。 一 般 采 用 AC 伺服 电机 。 
(3) 位 置 检测 : 检测 机 器 人 各 轴 运 行 位 置 的 器 件 。 采 用 绝对 位 置 编码 器 。 
(4) 动作 范围 : J1~J6 轴 以 “度数 ”为 单位 。 
(5) 最 大 速度 : J1 一 J6 轴 以 “ 度 / 秒 ” 为 单位 。 


(6) 最 大 动作 半径 : 在 基本 坐标 系 内 ,控制 点 的 动作 半径 范围 。 以 mm 为 单位 (以 机 械 


IF 坐标 原点 为 控制 点 ) 。 


(7) 最 大 合成 速度 : 指控 制 点 在 X-Y-Z 方向 上 的 最 大 矢量 速度 。 
1.4.2 机 器 人 的 “动作 自由 度 ” 
要 确定 一 个 刚体 (一 个 三 维 物体 ,而 不 是 一 个 点 ) 在 空间 中 的 位 置 , 首 先 需要 在 该 刚体 上 


选择 一 个 点 并 指定 该 点 的 位 置 , 因 此 需要 3 个 坐标 数据 来 确定 该 点 的 位 置 。 但 是 ,即使 位 置 
点 已 确定 , 仍 有 无 数 可 能 用 来 确定 物体 相对 于 所 选 “ 位 置 点 ”的 “ 形 位 ”( 因 为 刚体 还 可 以 绕 
“位 置 点 ”做 三 维 旋转 )。 为 了 完全 定位 空间 物体 的 * 形 位 ,除了 确定 物体 上 ”位置 点 ”的 位 置 
外 ,还 须 确定 该 物体 的 “ 形 位 ”。 根 据 空 间 几 何 学 分 析 , 需 要 6 个 数据 才能 完全 确定 刚体 物体 
的 位 置 和 * 形 位 ”。 基 于 同样 的 理由 ,就 需要 有 6 个 自由 度 才 能 将 物体 放置 到 空间 中 的 期 户 
位 置 上 。 因 此 为 抓 取 和 传送 在 空间 不 同位 置 和 "* 形 位 ?的 物件 ,传送 机 构 也 应 具有 6 个 自由 
度 。 每 一 个 自由 度 就 是 在 一 个 维度 上 运动 的 能 力 。 机 械 手 的 自由 度 越 多 ,表示 其 在 空间 定 
位 的 能 力 越 强 。 

机 械 手 的 每 一 个 自由 度 是 由 其 独立 驱动 关节 来 实现 的 ,所 以 在 实际 应 用 中 ,关节 和 自由 
度 在 表达 机 械 手 的 运动 灵活 性 方面 是 意义 相同 的 。 又 由 于 关节 在 实际 结构 上 是 由 回转 轴 或 
移动 轴 组 成 的 ,所 以 习惯 称 为 " 轴 ”。 因 此 ,就 有 6 自由 度 、6 关节 或 6 轴 机 械 手 的 命名 方法 。 
它们 都 说 明 某 机 械 手 的 操作 有 6 个 独立 驱动 的 关节 结构 ,能 在 工作 空间 实现 达到 任意 位 置 
和 " 形 位 >。 如 果 是 4 轴 机 器 人 就 表示 有 4 个 自由 度 。6 轴 机 器 人 的 动作 及 自由 度 如 图 1-2 
所 示 。 


机 械 接 口 
( 抓 手 安装 法 兰 面 ) 


Pas 
J6 轴 一 


图 1-2 6 轴 机 器 人 的 动作 及 自由 度 


1.4.3 机 器 人 动作 的 “最 大 速度 ” 


机 器 人 动作 的 最 大 速度 有 以 下 两 种 表示 方法 。 

(1) 用 每 一 轴 的 最 大 角速度 表示 ,如 表 1-3 所 示 。 

(2) 用 机 器 人 的 控制 点 ( 即 最 前 端 法 兰 的 中 心 点 ) 移 动 的 最 大 线 速度 表示 ,如 表 1-3 
所 示 。 

这 两 个 指标 在 机 器 人 技术 规格 中 已 经 规定 (各 型 号 指标 不 同 ) 。 
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表 1-3 机 器 人 的 最 大 角速度 和 最 大 线 速度 


轴 速度 类 型 RV-13F RV-20F 
用 轴 290 110 
J2 轴 234 110 
J3 轴 degli 312 110 
J4 轴 375 124 
J5 轴 375 125 
J6 轴 720 360 
最 大 合成 速度 mm/s 10 450 4200 


在 自动 程序 中 设置 速度 时 ,通常 以 最 大 速度 为 基准 ,设置 速度 倍率 一 一 百分数 ,获得 实 
际 速 度 。 


1.4.4 机 器 人 的 “最 大 动作 半径 ” 


在 基本 坐标 系 内 ,控制 点 的 最 大 动作 半径 范围 就 是 最 大 动作 半径 ”, 以 mm 为 单位 (以 
机 械 IF 坐标 原点 为 控制 点 ) ,如 图 1-3 和 图 1-4 所 示 。 


空 制 点 R 点 
控制 后 部 动作 限制 区 


| 
< 


P 点 动作 区 一 


二 起 
P 点 不 可 进入 区 


图 1-4 控制 点 的 最 大 动作 半径 范围 俯视 图 


1.4.5 机 器 人 的 “可 搬运 重量 ” 


“可 搬运 重量 ?是 指 机 器 人 以 额定 速度 运行 不 发 生 报警 的 能 搬运 移动 物体 的 重量 ,以 kg 
为 单位 。“ 可 搬运 重量 ?在 技术 规格 上 有 规定 ,是 选 型 时 的 重要 指标 。 部 分 型 号 的 机 器 人 可 
搬运 重量 如 表 1-4 所 示 。 

表 1-4 部 分 型 号 的 机 器 人 可 搬运 重量 
型 号 RV-2F RV-4F RV-7F RV-13F RV-20F 
可 搬运 重量 /kg 2 4 7 13 20 


如 图 1-5 所 示 为 机 器 人 在 搬运 重 物 。 


1-5 机 器 人 搬运 重 物 图 1-6 测试 机 器 人 重复 定位 精度 的 轨迹 


1.4.6 机 器 人 的 “位 置 重复 精度 ” 


机 器 人 的 “位 置 重复 精度 ” 指 机 器 人 夹 持 额定 重量 工件 ,以 高 速 动 作 模 式 (MvTune2)， 
按 如 图 1-6 所 示 的 轨迹 反复 运行 时 的 定位 精度 。 在 对 定位 精度 有 要 求 的 场合 ,这 个 指标 就 
显得 很 重要 。 

一 般 机 器 人 重复 定位 的 精度 可 达到 0. 02mm。 


1.5 控制 器 技术 规格 


如 表 1-5 所 示 为 控制 器 技术 规格 一 览 表 。 控 制 器 技术 规格 有 控制 轴 数 、 存 储 容量 、 可 控 
制 的 输入 输出 点 数 、 可 使 用 电源 范围 .内 置 接口 等 。 


表 1-5 控制 器 技术 规格 一 览 表 


项 目 单位 规 格 备 注 

型 号 CR751-Q,CR751-D 
控制 轴 数 最 多 6 轴 

示 教 位 置 数 点 39 000 
存储 容量 步 数 步 78 000 

程序 个 数 * 512 
编程 语言 MELFA-BASIC V 
位 置 示 教 方式 示 教 方式 或 MDI 方 式 
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续 表 
项 目 单位 规 格 备 注 
输入 输出 点 输入 点 /输出 点 最 多 可 扩展 至 256/256 
专用 输入 输出 点 分 配 到 通用 输入 输出 中 | STOP1 点 为 固定 
抓 手 开 闭 输入 输出 点 输入 8 点 /输出 8 点 内 置 
紧急 停止 输入 点 1 元 余 
门 开关 输入 点 1 元 余 
外 部 输入 输出 | 可 用 设备 输入 点 1 元 余 
紧急 停止 输出 点 1 元 余 
模式 输出 点 L 元 余 
机 器 人 出 错 输出 点 元 余 
附加 轴 同 步 点 元 余 
模式 切换 开关 输入 点 元 余 
RS-422 端口 1 TB 专用 
以 太 网 端口 1 
USB 端口 
接口 SSCNET3 
Se 志 光 : 与 MR-J3-B,MR-J4-B 连接 
跟踪 接口 通道 | 2 连接 编码 器 
选 购 件 插 模 插 槽 “| 2 连接 选 购 件 IO 
RV-4F 系列 : 
单 相 AC(180 一 253)V 
输入 电源 范围 V RV-7F/13F 系列 : 
三 相 AC(180 一 253)V 或 
电源 单 相 AC(207 一 253)V 
RV-4F 系列 : 1.0 
电源 容量 kVA | RV-7F 系列 : 2.0 
RV-13F 系列 : 3.0 
频率 Hz 50/60 
控制 器 技术 规格 名 词 术语 如 下 。 
1. 第 1 部 分 


存储 容量 : 指 用 示 教 单元 可 以 示 教 确认 的 位 置 点 数量 。 
步 数 : 指 一 个 程序 内 的 “ 步 数 ”, 例 如 78 000 步 。 
程序 个 数 : 指 同时 可 以 存放 在 控制 器 内 的 程序 数量 。 
编程 语言 : MELFA-BASIC V。 
位 置 示 教 方式 : 是 用 示 教 单元 驱动 机 器 人 本 体 ,对 当前 位 置 进 行 记录 的 方式 。 

MDI 方 式 : MDI 是 Manual Data Input 的 缩写 ,是 将 数值 直接 输入 以 确定 “位 置 点 ”的 


方式 。 


外 部 输入 输出 : 指 通过 使 用 外 部 1/O 单元 或 模块 可 扩展 的 输入 输出 点 数量 ,例如 1265/ 


O256。 


专用 输入 输出 : 指 由 控制 器 内 部 已 经 定义 的 输入 输出 的 功能 。 


抓 手 开 闭 输入 输出 : 专门 用 于 控制 抓 手 的 输入 输出 点 ,例如 18/O8。 


RS-422 通信 口 : 控制 器 内 置 的 串 行 通信 口 。TB( 示 教 单元 ) 专 用 。 

2. 第 2 部 分 

以 太 网 端口 : 控制 器 内 置 的 以 太 网 通信 口 。 

USB 接口 : 控制 器 内 置 的 USB 通信 口 ,用 于 计算 机 与 机 器 人 连接 。 

附加 轴 接 口 : 控制 器 内 置 的 通信 口 ,用 于 SCNET 夺 与 MR-J3-B、MR-J4-B 系列 伺服 驱 
动 器 的 连接 。 

采样 接口 : 控制 器 内 置 编 码 器 信号 接口 ,用 于 接收 来 自 外 部 编码 器 的 信号 ,在 视觉 追踪 
等 场合 经 常 使 用 。 

选 购 件 插 槽 : 控制 器 内 置 的 插口 ,用 于 安装 外 部 IO 卡 。 

输入 电压 范围 : 控制 器 使 用 的 电压 范围 。 

(1) RV-4F 系列 : AC(180 一 253)V。 

(2) RV-7F/13F 系列 : 三 相 AC(180 一 253)V 或 单 相 AC(207 一 253)V。 

电源 容量 kVA: 

(1) RV-4F 系列 : 1.0。 

(2) RV-7F 系列 : 2.0。 

(3) RV-13F 系列 : 3.0。 


1.6 需要 思考 的 问题 


(1) 什么 是 机 器 人 的 合成 速度 ? 
(2) 什么 是 机 器 人 的 搬运 重量 ? 
(3) 如 何 测定 机 器 人 的 重复 定位 精度 ? 
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【学 习 目 的 】 

在 第 2 日 的 学 习 中 ,要 学 习 机 器 人 的 实际 安装 和 连接 ,了 解 机 器 人 和 控制 器 各 接口 的 名 
称 和 功能 ,了 解 如 何 连 接 “ 急 停 信 号 ”和 “模式 选择 信号 ”, 如何 连接 “启动 信号 ”和 “停止 信 
号 ”, 如 何 初 步 定 义 外 部 1/O 卡 各 输入 输出 端子 的 功能 。 只 有 将 机 器 人 系统 连接 起 来 ,才能 
使 机 器 人 运动 。 


2.1 工业 机 器 人 各 部 分 的 名 称 及 用 途 


三 萎 垂 直 型 6 轴 机 器 人 各 部 分 名 称 如 图 2-1 所 示 。 


J4 轴 


J5 轴 、 


机 械 接口 
( 抓 手 安装 法 兰 面 ) 


+/ 
J6 铀 


图 2-1 机 器 人 各 部 分 名 称 及 用 途 


本 节 以 三 萎 垂 直 型 6 轴 机 器 人 为 例 ,说 明 各 部 分 的 名 称 及 用 途 。 
(1) 基 座 : 基 座 是 安装 机 器 人 的 机 械 构件 。 基 座 的 中 心 点 就 是 机 器 人 基本 坐标 系 的 原 
点 。 垂 直 型 机 器 人 可 以 有 落地 式 、. 吊 项 式 、 壁 挂 式 等 多 种 安装 方式 。 


(2) 各 轴 旋 转 方向 : J1 轴 、J2 轴 、J3 轴 、J4 轴 、J5 轴 、J6 轴 各 自在 空间 的 旋转 方向 如 
图 2-1 所 示 。 


(3) 抓 手 安装 法 兰 面 : 抓 手 安装 法 兰 面 在 J6 轴 上 ,用 于 安装 抓 手 。 法 兰 面 的 中 心 就 是 
TOOL 坐标 系 的 原点 。 


2.2 控制 器 各 接口 的 说 明 


机 器 人 控制 器 的 接口 如 图 2-2 所 示 。 


控制 器 正面 图 


风扇 口 


2-2 控制 器 接口 示意 图 


1. 控制 器 各 部 分 接口 名 称 及 用 途 

在 机 器 人 系统 中 ,机 器 人 本 体 与 控制 器 是 分 离 的 ,就 像 在 数控 机 床 中 机 床 本 体 与 控制 器 
分 离 一 样 。 本 节 以 CR751-D( 独 立 型 ) 控 制 器 为 例 ,说 明 控制 器 各 接口 的 作用 。 

对 CR751-D 控制 器 接口 及 其 功能 的 说 明 如 下 。 

(1) ACIN 连接 器 一 一 AC 电源 ( 单 相 .AC200V) 输 入 用 插口 。 

(2) PE 端子 一 一 接地 端子 。 

(3) POWER 指示 灯 一 一 控制 电源 ON/OFF 指示 灯 。 

(4) 电机 电源 连接 插口 AMP1、AMP2 一 一 电机 电源 用 插口 。BRK: 电机 制动器 插口 。 

(5) 电机 编码 器 连接 插口 CN2 一 一 电机 编码 器 插口 。 

(6) 示 教 单元 连接 插口 (TB) 一 一 R33TB 连接 专用 (未 连接 示 教 单元 时 需要 安装 标 配 
插头 ) 。 

(7) 过 滤器 盖 板 一 一 空气 过 滤器 .电池 安装 两 用 。 

(8) CNUSR 插口 一 一 机 器 人 专用 输入 输出 插口 (附带 插头 )。 

(9) 接地 端子 。 

(10) 充电 指示 灯 一 一 确认 拆卸 盖 板 时 的 安全 (防止 触电 ) 指 示 灯 。 当 机 器 人 伺服 王 ON 
使 得 控制 器 内 的 电源 基板 上 积累 电能 时 ,本 指示 灯亮 灯 ( 红 色 )。 关 闭 控制 电源 经 过 一 定时 
间 ( 几 分 钟 ) 后 灯 熄 灭 。 

(11) USB 插口 一 一 USB 连接 用 。 

(12) LAN 插口 一 一 以 太 网 连接 插口 。 
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(13) Export 插口 一 一 附加 轴 连 接 用 插口 。 
(14) RIO 插口 一 一 扩展 输入 输出 模块 用 插口 。 
(15) 选 购 件 插 槽 一 一 选 购 件 卡 安装 用 插 槽 。 


2.3 机 器 人 与 控制 器 连接 


机 器 人 本 体 与 控制 器 的 连接 如 图 2-3 所 示 。 


电机 电源 电机 信号 
CNI 


机 器 人 本 体 


电机 信号 电缆 


电机 电源 电缆 
图 2-3 机 器 人 本 体 与 控制 器 的 连接 


机 器 人 本 体 与 控制 器 主要 通过 两 条 电缆 连接 。 
(1) 电源 电缆 一 一 通过 CN1 连接 。 
(2) 编码 器 反馈 电缆 一 一 通过 CN2 口 连接 。 


2.4 机 器 人 与 外 围 设备 连接 


1. 控制 器 电源 连接 

电源 电缆 属于 标 配 。 根 据 机 器 人 型 号 不 同 ,使 用 单 相 220V 电源 或 者 使 用 三 相 220V 电 
源 。 需 要 使 用 一 个 能 够 提供 三 相 220V 的 变压器 。 变 压 器 的 容量 应 该 是 “控制 器 规格 一 览 
表 ” 中 电源 容量 要 求 的 1.2 一 1.5 售 。 

不 能 直接 使 用 工厂 里 的 三 相 380V 电源 ,否则 会 立即 烧毁 控制 器 。 

在 主 电 源 回 路 应 该 接 入 “断路 器 "和 “ 空 开 ”。 

2. 控制 器 与 GOT 的 连接 

通过 以 太 网 口 连接 。 

3. 控制 器 与 计算 机 的 连接 

可 以 通过 以 太 网 口 连 接 , 也 可 以 通过 USB 口 连接 ,实际 使 用 中 多 通过 USB 连接 。 


2.5 和 急 停 及 安全 信号 


“外 部 急 停 开关 ”和 “ 门 保护 开关 ”的 接线 如 图 2-4 所 示 。 
这 些 开 关 信 号 都 接 入 CNUSRI1 接口 。CNUSR1 接口 是 控制 器 标 配 接口 ,如 图 2-5 所 示 。 


用 户 配 线 侧 内 部 电路 _， 儿 户 配 线 仙 
CNUSRI1 
| TB 名 停 全 +424V CNUSR1 
Ss 模式 输出 1 | “8 |] 4 
@|43 1 | op d@|26h 
四 |20 1 4182 
1 急 停 输出 | 1 人 A) 继电器 | 画 |57| 一 外 部 急 停 输 入 
@|17 机 1 1 名 [3Pp 一 | 短路 
En 模式 输出 。 | 1 d@l28h | 和 
1 1 — 
S 急 停 输出 1 124VGND 人 加 四 
| ! 由 继电器 于 [车 | 二 一 门 开关 输入 
1 24YGOND 由 一 +42V 是 J@[s | 
' 1 (RA) 于 电 茵 _j@f30| 一 安全 设备 输入 
24VGND 
| 2 
1 1 +2V &[6 
1 1 短路 
一 | oro d ®|31b. 
三 人 出 错 输出 1 一 el7|- 国 
Ec | (本 一 1@j | 外 闻名 人 输入 
机 二 出 错 输出 。 | d@lsb , 
1 d ®@|33b 短路 
1 
1 24VGND” 4 二 | 可 5 
[NO 19 一 门 开关 输入 
24vGND 0 急电 祯 | 全 || 二 安全 设备 输入 
24VGND”” 


2-4 外 部 安全 开关 的 配 线 


CNUSR1 连 接 器 


铁 氧 体 磁 芯 
穿 过 两 次 


图 2-5 从 控制 器 的 CNUSR1 接口 引出 的 “特别 输入 输出 信号 ” 


1. 外 部 急 停 开关 

外 部 急 停 开关 一 般 指 安装 在 操作 面板 上 的 急 售 开关。 当然, 急 停 开关 可 以 装 在 生产 线 
的 任何 必要 部 位 。 外 部 急 停 开关 采用 B 接点 元 余 配 置 ,如 图 2-4 所 示 。 外 部 急 停 开关 在 
CNUSR1 插口 引出 电缆 的 2 一 37 和 7 一 32 端子 之 间 。 

所 谓 元 余 配置 是 指 在 配 线 时 必须 使 用 双 触 点 型 “ 急 停 开 关 ”, 保 证 即使 在 一 个 触 点 失效 
时 ,另外 一 个 触 点 也 能 够 切断 “ 急 停 回路 ”。 


种 2 日 一 一 工业 帮 器 人 的 安装 和 过 共 


十 久 小 


30 日 学 嵌 工 业 机 器 人 


2. 门 开关 

门 开关 用 于 检测 工作 门 的 开启 关闭 状态 。 门 开关 采用 B 接点 元 余 配置 。 在 正常 状态 
下 , 门 保 护 开关 的 功能 是 在 设备 的 防护 门 被 打开 时 使 机 器 人 伺服 系统 二 OFF ,停止 动作 起 到 
安全 保护 作用 。 设 备 的 门 打 开 以 后 ,机 器 人 停止 运行 ,以 免 出 现 伤 人 事故 。 门 开关 的 功能 是 
使 伺服 二 ON/OFF。 

“ 门 开 关 ” 在 CNUSRI 插口 引出 电缆 的 4 一 29 和 9 一 34 端子 之 间 。 

所 谓 宛 余 配置 是 指 在 配 线 时 必须 使 用 双 和 触 点 型 “开关 ”, 保 证 即使 在 一 个 触 点 失效 时 , 另 
外 一 个 触 点 也 能 够 切断 “ 门 开 关 回 路 ”。 

门 保护 开关 必须 为 “ 常 闭 型 "?。 门 打开 时 , 门 保护 开关 = OFF。 

自动 运行 时 : 门 打开 一 伺服 停止 一 报警 。 

解除 : 关门 一 复位 一 伺服 ON 一 启动 。 

3. 安全 辅助 (可 用 设备 ) 开 关 

安全 辅助 开关 功能 : 对 示 教 作业 进行 保护 。 如 果 在 示 教 作业 中 出 现 异常 , 按 下 “安全 辅 
助 开关 ”, 能 够 使 伺服 二 OFF ,停止 机 器 人 运动 。 安 全 辅助 开关 采用 B 接点 宛 余 配置 。“ 安 
全 辅助 开关 ”在 CNUSR1 插口 引出 电缆 的 5 一 30 和 10 一 35 端子 之 间 ,也 是 元 余 配置 。 

4. 跳跃 信号 

SKIP 信号 是 跳跃 信号 , 当 SKIP 二 ON 时 , 则 立即 停止 执行 当前 程序 行 , 跳 到 “指定 的 程 
序 行 "。SKIP 信号 端子 在 CNUSR2 口 的 9 一 34。SKIP 信号 的 接 法 如 图 2-6 所 示 。 


项 目 规 格 内 部 电路 
型 式 DC 输入 
输入 点 数 1 
绝缘 方式 光电 耦合 器 绝缘 
额定 输入 电压 DC24V 
额定 输入 电流 约 11mA 二 OD 
使 用 电压 范围 DC(21.6 一 26.4)V( 波 动 率 5% 以 内 ) 
ON 电压 /ON 电流 DC8V 以 上 /2mA 以 上 > 立 330Q 
OFF 电压 /OFF 电流 DC4V 以 下 /lmA 以 下 
输入 电阻 约 2.2kQ 了 34 输入 
OFF>ON | lms 以 下 
用 应 时 间 | ”ONEOEF | las M 下 
公共 端 方式 一 点 一 个 公共 端 
外 线 连接 方式 连接 器 


2-6 ”SKIP 信号 的 接 法 


2.6 模式 选择 信号 


机 器 人 的 工作 模式 有 “自动 模式 ”和 “手动 模式 ”"。“ 工 作 模 式 选择 ”是 指 选择 机 器 人 的 工 
作 模 式 。 

1. 自动 模式 

通过 (操作 面板 上 的 ) 外 部 信号 控制 程序 “启动 ”或 “停止 *。 要 将 “操作 权 ” 信 号 切换 为 


“外 部 信号 ”有 效 状 态 。 

2. 手动 模式 

通过 “ 示 教 单元 ”的 JOG 模式 操作 机 器 人 动作 。 

“工作 模式 选择 ”的 信号 标 配 在 CNUSR1 接口 的 规定 信号 端子 49 一 24 和 50 一 25, 如 
图 2-7 及 表 2-1 所 示 ( 源 型 接 法 ,24V 电源 由 控制 器 提供 ) 。 


模式 选择 
一 


9 个“ 


模式 切换 开关 


SN 


插口 CNUSR1 


图 2-7 模式 选择 开关 的 电缆 插口 
表 2-1 模式 选择 开关 的 针脚 编号 


插口 : CNUSR1 切换 模式 
针脚 编号 功能 手动 模式 自动 模式 
49 1 输入 接点 
OFF ON 
24 1 输入 电源 十 24V 
50 2 输入 
OFF ON 
25 2 输入 电源 十 24V 


2.7 输入 输出 信号 的 连接 


2.7.1 概述 


除了 控制 器 标 配 的 (CNUSR1/CNUSR2) 输 入 输出 信号 (有 急 停 信号 ,安全 信号 .模式 选 
择 信和 号) 之 外 ,为 了 实现 更 多 的 控制 功能 ,包括 对 外 部 设备 的 控制 和 信号 检测 ,实用 的 机 器 人 
系统 需要 使 用 更 多 的 1/O 信号。 机 器 人 系统 可 以 扩展 的 外 部 MO 信和 号 为 256/256 点 。 扩 
展 外 部 I/O 信号 的 方法 可 以 通过 配置 “I/O 模块 "和 “1/O 接口 板 ? 来 实现 。 


2.7.2 实用 板 卡 配置 


机 器 人 系统 配置 的 “外 部 I/O 模块 "有 “ 板 卡 型 "和 “模块 型 "两 种 。 

1. 板 卡 型 

(1) 板 卡 型 2D-TZ368、2D-TZ378 可 直接 插 接 在 控制 器 的 SLOT1、SLOT2 的 插口 (32 
点 输入 ,32 点 输出 )。 

(2) 板 卡 必须 有 对 应 的 “站 号 ”。 这 与 一 般 控 制 系统 相同 ,只 有 设置 站 号 ,才能 分 配 确定 
的 1/O 地 址 。 使 用 * 板 卡 型 IO” 时 ,站 号 根据 插入 的 SLOT 确定 。 

SLOT1= 站 号 1 ”SLOT2== 站 号 2 


种 2 日 一 -工业 帮 器 人 的 安装 和 过 共 


击 久 蛋 


30 日 学 典 工 业 帮 器 人 


2. 模块 型 
模块 型 输入 输出 单元 配置 有 外 壳 .相对 独立 ,通过 专用 电缆 与 控制 器 连接 。 


2.7.3 板 卡 型 2D-TZ368( 汤 型 ) 的 输入 输出 电路 技术 规格 


1. 输入 电路 技术 规格 

输入 信号 的 漏 型 接 法 如 图 2-8 所 示 。 
(1) 输入 电压 : DC(12~24)V。 

(2) 输入 点 数 : 32 点 。 

(3) 公共 端 方式 : 32 点 共 一 个 公共 端 。 


项 目 规格 
形式 DC 输入 
绝缘 方式 光电 绝缘 
额定 输入 电压 / 额 “| DC 12V/3mA DC 24V/9mA 
定 输入 电流 


使 用 电压 范围 DV(10.2~26.4)V 

ON 电压 /ON 电流 | DC 8V 以 上 /2mA 以 上 
OFF 电 压 /OFF 电 流 | DC 4V 以 下 /lmA 以 下 
输入 电阻 2.7kQ 
响应 时 间 OFF 一 ON| 10ms 以 下 
响应 时 间 ON 一 OFF| 10ms 以 下 

公共 端 方式 32 点 共 一 个 公共 端 
外 线 连接 方式 连接 器 


+24V/+12V 
COM 
Yy 8200 
[一 输入 端 
2.7kQ 


漏 型 


图 2-8 输入 信号 的 漏 型 接 法 


所 谓 “ 公 共 端 COM” 是 指 板 卡 本 身 这 些 输 入 点 的 “公共 端 "。 一 个 板 卡 上 有 32 个 输入 
点 ,这 些 输入 点 的 接 法 一 样 ,所 以 就 只 有 一 个 公共 接点 ( 漏 型 共 DC24V 十 ) (在 一 个 回路 中 ， 
输入 模块 的 “点 ” 视 作 “ 负 载 ”) 。 

(4) 漏 型 / 源 型 接 法 。 

@ 开关 点 与 电源 正极 相连 即 为 源 型 接 法 。 

@ 开关 点 与 电源 负极 相连 即 为 漏 型 接 法 。 

2. 输出 电路 技术 规格 

输出 信号 的 漏 形 接 法 如 图 2-9 所 示 。 

(1) 输出 形式 : 晶体 管 输出 。 

DC24V 电源 由 外 部 提供 ,DC(12 一 24)V。 


项 目 规格 


形式 晶体 管 输出 
输出 点 数 32 

绝缘 方式 光电 绝缘 

额定 负载 电压 DC 12V/ DC 24V 
使 用 电压 范围 DV(10.2~30)V 

最 大 负载 电流 0.1A/ 点 

OFF 时 泄露 电流 0.ImA 以 下 

ON 最 大 电压 降 DC 0.9V 以 下 
输入 电阻 2.7kQ 


响应 时 间 OFF 一 ON | 10ms 以 下 
响应 时 间 ON 一 OFF | 10ms 以 下 


额定 保险 丝 1.6A 

公共 端 方式 16 点 共 一 个 公共 端 
外 线 连接 方式 连接 器 

外 部 供电 电源 DC12/24V 60mA 
漏 型 


+24V/+12V 


中 - 


保险 丝 


2-9 输出 信号 的 漏 型 接 法 


(2) 输出 点 数 : 32 点 。 

(3) 公共 端 方式 : 16 点 共 一 个 公共 端 。 

3. 1/O 卡 2D-TZ368 与 PLC 输入 输出 模块 的 连接 

如 图 2-10 所 示 是 2D-TZ368 与 PLC 输入 输出 模块 的 连接 图 。 其 中 ,QX41 是 PLC 输入 
模块 ,QY81P 是 PLC 输出 模块 。 

2D-TZ368 与 PLC 输入 输出 模块 的 连接 为 漏 型 接 法 。 

(1) 漏 型 输出 电路 。 在 图 2-10 中 ,由 外 部 DC24V 电源 给 输出 部 分 的 三 极 管 提供 工作 
电源 ,所 以 必须 在 规定 的 点 接 入 外 部 DC24V 电源 。 在 “电源 一 开关 一 负载 "回路 中 ,其 电流 
流向 是 “DC24V 十 一 负载 (QX41) 一 集 电极 (TZ368) 一 发 射 极 (DCOV)”。 

(2) 漏 型 输入 电路 。 其 流向 是 “DC24V 十 一 负载 (TZ368) 一 集 电极 (QY81P) 一 发 射 极 
(DCOV)”。 

在 一 个 标准 回路 中 ,输出 模块 的 每 一 点 相当 于 一 个 开关 。 一 个 板 卡 上 有 32 个 输出 点 ， 
这 些 输出 点 的 接 法 一 样 ,所 以 也 有 一 个 公共 接点 COM( 漏 型 , 共 DCOV) 。 

如 果 三 极 管 的 发 射 极 接 DCOV, 则 三 极 管 的 “ 集 电 极 " 接 “负载 ", 这 就 是 所 谓 的 “ 集 电极 ” 
开路 ,其 公共 端 就 是 DCOV 。 


种 2 日 一 一 工业 帮 器 人 的 安装 和 过 共 


地 忆 由 


30 日 学 烧 工 业 胡 器 人 


人 QX41( 三 萎 可 编程 控制 器 ) 
时 
60mA 
24VH+l2V 六 CoM 
+ | 茹 : 
一 +24V 
保险 丝 | 
外 部 电源 一 一 -一 
(输入 ) QY81P( 三 萎 可 编程 控制 器 ) 
上 = COM 24V 
4 输入 | Yl 
330 : 
1 给 入 +24V 
| 24G(24GND) 
ee 外 部 电源 


图 2-10 2D-TZ368 与 PLC 输入 输出 模块 的 连接 图 


2.7.4 板 卡 型 2D-TZ378( 源 型 ) 的 输入 输出 电路 技术 规格 


1. 输入 电路 技术 规格 


输入 电路 技术 规格 如 图 2-11 所 示 。 


项 目 规格 

形式 DC 输入 
输入 点 数 32 
绝缘 方式 光电 绝缘 
额定 输入 电压 /额定 | DC 12V/3mA DC 24V/9mA 
输入 电流 
使 用 电压 范围 DV(10.2~26.4)V 
ON 电压 /ON 电流 “| DC 8V 以 上 /2mA 以 上 
OFF 电 压 /OFF 电 流 | DC 4V 以 下 /ImA 以 下 
输入 电阻 2.7kQ 
响应 时 间 OFF 一 ON| 10ms 以 下 
响应 时 间 ON 一 OFF| 10ms 以 下 
公共 端 方式 32 点 共 一 个 公共 端 
外 线 连 接 方式 连接 器 

2.7kQ 

输入 端 


2-11 输入 电路 技术 规格 


(1) 输入 电压 : DC(12~24)V。 
(2) 输入 点 数 : 32 点 。 


(3) 公共 端 方式 : 32 点 共 一 个 公共 端 。 


2. 输出 电路 技术 规格 


输出 电路 技术 规格 如 图 2-12 所 示 。 
(1) 输出 形式 : 晶体 管 输出 。DC24V 电源 由 外 部 提供 ,DC(12 一 24)V。 


(2) 输出 点 数 : 32 点 。 


(3) 公共 端 方式 : 16 点 共 一 个 公共 端 。 


项 目 规格 
形式 晶体 管 输出 
输入 点 数 32 
绝缘 方式 光电 耦合 器 绝缘 
额定 负载 电压 DC 12V/ DC 24V 
使 用 电压 范围 DV(10.2~30)V 
最 大 负载 电流 0.1A/ 点 
OFF 时 沪 露 电流 0.1mA 以 下 
ON 最 大 电压 降 DC 0.9V 以 下 
输入 电阻 2.7kQ 
响应 时 间 OFF 一 ON | 10ms 以 下 
响应 时 间 ON 一 OFF | 10ms 以 下 
额定 保险 丝 1.6A 
公共 端 方式 16 点 共 一 个 公共 端 
外 线 连 接 方式 连接 器 
外 部 供电 电源 DC12V~24V 60mA 
源 型 


中 


保险 丝 


+24V/+12V 


图 2-12 输出 电路 技术 规格 


3. 1/O 卡 2D-TZ378 与 PLC 输入 输出 模块 的 连接 
如 图 2-13 所 示 是 2D-TZ378 与 PLC 输入 输出 模块 的 连接 图 。 其 中 ,QX81 是 PLC 输入 


模块 ,QY81P 是 PLC 输出 模块 。 


2D-TZ378 与 PLC 输入 输出 模块 的 连接 为 源 型 接 法 。 
(1) 源 型 输出 电路 。 在 图 2-13 中 ,由 外 部 DC24V 电源 给 输出 部 分 的 三 极 管 提供 工作 


电源 ,所 以 必须 在 规定 的 点 接 入 外 部 DC24V 电源 。 在 “电源 一 开关 一 负载 ?回路 中 ,电流 的 
流向 是 “DC24V 十 一 开关 点 (TZ378) 一 负载 (QX81) 一 (DCOV) 。” 

(2) 源 型 输入 电路 。 其 流向 是 “DC24V 十 一 开关 点 (QY81P) 
(DCOV)”。 


负载 (TZ378) 一 COM 


击 访 测 


种 2 日 一 -工业 帮 器 人 的 安装 和 过 共 


30 日 学 烧 工 业 夫 器 人 


并 行 输入 输出 模块 QX81( 三 萎 可 编程 控制 器 ) 
(输出 ) ， 
60mA 
保险 丝 | (+24V/+12V) 
输出 六 
下 给 出 +24V 平 ~K 
COM 
Direow 
外 部 电源 
(输入 ) QY81P( 三 萎 可 编程 控制 器 ) 
+24V 
3.3kQ | 输入 gr 
= 从 
2 输 24G(24GND) 
(COM| Lizav 


外 部 电源 
图 2-13 2D-TZ378 与 PLC 输入 输出 模块 的 连接 图 


在 实际 布线 中 必须 严格 分 清 漏 型 、 源 型 接 法 ,如 果 接 错 会 烧毁 1/0 板 。 
2.7.5 硬件 的 插口 与 针脚 定义 


硬件 的 插口 与 针脚 定义 如 下 。 

I/O 卡 2DTZ-368 安装 在 控制 器 的 SLOT1 或 SLOT2 插口 中 ,由 连接 电缆 引出 。 其 针 
脚 分 布 如 图 2-14 和 表 2-2 所 示 。 现 场 连接 时 ,注意 电缆 颜色 与 针脚 的 关系 ,如 表 2-3 和 
表 2-4 所 示 。 
连接 器 (2) 
输出 16~31 


输入 16~31 
(站 号 0 时 ) 


输入 0~15 
并 行 输入 输出 接口 的 连接 器 针 配 置 (站 号 0 时 ) 


图 2-14 输入 输出 卡 的 硬件 插口 
表 2-2 在 各 硬件 插口 内 输入 输出 信号 的 范围 


通用 输入 输出 编号 范围 
插 槽 编号 站 号 
连接 器 (1) 连接 器 (2) 
输入 : 0 一 15 输入 : 16 一 31 
SLOT1 0 输出 ; 0 一 15 输出 : 16 一 31 
输入 : 32 一 47 输入 : 48 一 63 
SLOT2 1 输出 : 32 一 47 输出 : 48 一 63 


表 2-3 插口 1 输入 输出 信号 的 针脚 与 电线 颜色 的 关系 


针脚 编号 线 色 信 号 名 针脚 编号 线 色 售 号 名 
ie 橙 红 a 0V 1D 栖 黑 a 
2C 灰 红 a COM 2D 灰 黑 a 
3C 白 红 a 空 端子 3D 白 黑 a 
4C 黄 红 a 空 端子 4D 黄 黑 a 
5C 桃红 a 通用 输入 15 5D 桃 黑 a 通用 输出 15 
6C 橙 红 b 通用 输入 14 6D 橙 黑 b 通用 输出 14 
7C 灰 红 b 通用 输入 13 7D 灰 黑 b 通用 输出 13 
8C 白 红 b 通用 输入 12 8D 白 黑 b 通用 输出 12 
9C 黄 红 b 通用 输入 11 9D 黄 黑 b 通用 输出 11 
10C 桃红 b 通用 输入 10 10D 桃 黑 b 通用 输出 10 
11C 橙 红 c 通用 输入 9 11D 橙 黑 c 通用 输出 9 
12C 灰 红 c 通用 输入 8 12D 灰 黑 c 通用 输出 8 
13C 白 红 c 通用 输入 7 13D 白 黑 c< 通用 输出 7 
14C 黄 红 c 通用 输入 6 14D 黄 黑 c 通用 输出 6 
15C 桃红 通用 输入 5 15D 桃 黑 c 通用 输出 5 
16C 橙 红 d 通用 输入 4 16D 橙 黑 d 通用 输出 4 
26 灰 红 d 通用 输入 3 17D 灰 黑 d 通用 输出 3 
18C 白 红 d 通用 输入 2 18D 白 黑 d 通用 输出 2 
19C 黄 红 d 通用 输入 1 19D 黄 黑 d 通用 输出 1 
20C 桃红 d 通用 输入 0 20D 桃 黑 d 通用 输出 0 

表 2-4 插口 2 输入 输出 信号 的 针脚 与 电线 颜色 的 关系 

针脚 编号 线 色 信 号 名 针脚 编号 线 色 信 号 名 
1A 橙 红 a 0V 1B 橙 黑 a 
2A 灰 红 a COM 2B 灰 黑 a 
3A 白 红 a 空 端子 3B 白 黑 a 
4A 黄 红 a 空 端子 4B 黄 黑 a 
5A 桃红 a 通用 输入 31 5B 桃 黑 a 通用 输出 31 
6A 橙 红 b 通用 输入 30 6B 橙 黑 b 通用 输出 30 
7A 灰 红 b 通用 输入 29 7B 灰 黑 b 通用 输出 29 
8A 白 红 b 通用 输入 28 8B 白 黑 b 通用 输出 28 
9A 黄 红 b 通用 输入 27 9B 黄 黑 b 通用 输出 27 
10A 桃红 b 通用 输入 26 10B 桃 黑 b 通用 输出 26 
11A 橙 红 c 通用 输入 25 11B 橙 黑 c 通用 输出 25 
12A 灰 红 < 通用 输入 24 12B 灰 黑 c 通用 输出 24 
13A 白 红 c 通用 输入 23 13B 白 黑 c 通用 输出 23 
14A 黄 红 c 通用 输入 22 14B 黄 黑 c 通用 输出 22 
15A 桃红 c 通用 输入 21 15B 桃 黑 c 通用 输出 21 
16A 橙 红 d 通用 输入 20 16B 橙 黑 d 通用 输出 20 
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续 表 

针脚 编号 线 色 售 号 名 针脚 编号 线 ， 色 售 号 名 
17A 灰 红 d 通用 输入 19 17B 灰 黑 d 通用 输出 19 
18A 白 红 d 通用 输入 18 18B 白 黑 d 通用 输出 18 
19A 黄 红 d 通用 输入 17 19B 黄 黑 d 通用 输出 17 
20A 桃红 d 通用 输入 16 20B 桃 黑 d 通用 输出 16 


各 电缆 的 接 法 如 图 2-15 所 示 。 
COM(+24~+12)V 


pis 输入 15 


414-Y 输入 14 


输入 13 


输入 12 


Ps 
下 站 输入 0 


图 2-15 各 输入 端子 的 连接 方法 


2.7.6 输入 输出 模块 2A-RZ361 


输入 输出 模块 2A-RZ361, 有 外 过 ,类 似 于 较为 独立 的 模块 。 每 一 模块 和 板 卡 都 必须 设 
置 “站 号 ”。 这 与 一 般 控制 系统 相同 ,只 有 设置 站 号 ,才能 分 配 确定 的 1/0 地 址 。 


2.8 实用 机 器 人 控制 系统 的 构建 


一 套 实用 的 机 器 人 控制 系统 的 构建 如 图 2-16 所 示 。 

1. 主 回路 电源 系统 

1) 电源 等 级 

在 主 回路 系统 中 必须 特别 注意 : 机 器 人 使 用 的 电源 为 单 相 220V 或 三 相 220V ,不 是 工 
厂 现场 使 用 的 三 相 380V。 要 根据 机 器 人 的 型 号 确定 其 电源 等 级 。 

使 用 三 相 220V 电源 时 ,需要 专门 配置 三 相 220V 变压器 。 

2) 主要 安全 保护 元 件 

在 主 回路 中 应 该 配置 : 无 熔 丝 断路 器 ,接触 器 。 


LiLZ2E3 


单 相 220V a 
三 相 220V [EC Cre 


| 电机 编码 | 
器 电缆 ， 


/vo 
(操作 盘 电缆 ) 


ER 
Fn 继电器 1/O 控 制 
图 2-16 实用 机 器 人 控制 系统 的 构建 
3) 专用 电缆 


在 机 器 人 控制 器 一 侧 , 有 专用 的 电源 插口 。 出 厂 时 配置 有 电源 电缆 ,如 果 长 度 不 够 ,用 
户 可 以 将 电缆 加 长 。 

4) 控制 电源 

在 主 回路 中 再 接 人 一 个 “控制 变压器 ”。 控 制 变 压 器 提供 DC24V 直流 电源 ,可 以 供 操 
作 面 板 和 外 围 I/O 电路 使 用 。 

2. 控制 器 与 机 器 人 本 体 连接 

伺服 电机 的 电源 电缆 和 伺服 电机 编码 器 的 电缆 是 机 器 人 的 标 配 电线。 注意 ,CN1 口 是 
电机 电源 电缆 插口 ,CN2 口 是 电机 编码 器 电缆 插口 。 

3. 操作 面板 与 控制 器 的 连接 

操作 面板 由 用 户 自制 ,至 少 包括 以 下 按钮 。 

(1) 电源 ON; 

(2) 电源 OFF; 

(3) 急 停 ; 

(4) 工作 模式 选择 (选择 型 开关 ); 

(5) 伺服 ON; 

(6) 伺服 OFF; 

(7) 操作 权 ; 

(8) 自动 启动 ; 

(9) 自动 停止 ; 

(10) 程序 复位 ; 

(11) 程序 号 设置 (波段 选择 开关 ); 
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(12) 程序 号 确认 。 


这 些 信 号 来 自 于 控制 器 的 不 同 插口 ,如 表 2-5 所 示 。 


表 2-5 工作 信号 及 其 插口 


序 号 按钮 名 称 对 应 插口 
1 电源 ON 主 回路 控制 电路 
2 电源 OFF 主 回路 控制 电路 
3 急 停 控制 器 CNUSRI1 插口 
4 工作 模式 选择 控制 器 CNUSR1 插口 
5 伺服 ON 
6 伺服 OFF 
7 操作 权 
8 自动 启动 
下 动 停 下 SLOT1 中 IO 板 2D-TZ368 
10 程序 复位 
11 程序 号 选择 
驶 程序 号 确认 


在 配 线 时 要 分 清 强 电 和 弱电 (电源 等 级 ) ,分 清 是 源 型 接 法 还 是 漏 型 接 法 ,如 果 接 法 错误 
会 烧毁 设备 。 

4. 外 围 检 测 开关 和 输出 信号 

SLOT1 中 1O 板 2D-TZ368 是 输入 输出 信号 接口 板 , 共 有 输入 信号 32 点 ,输出 信号 32 
点 ,可 以 满足 一 般 控制 系统 的 需要 。 外 围 检 测 开 关 如 位 置 开 关 和 各 种 显示 灯 信 号 全 部 可 以 
接 人 2D-TZ368 接口 板 中 。 注 意 ,2D-TZ368 输入 输出 都 是 漏 型 接 法 ,需要 提供 外 部 DC24V 
电源 。 

由 于 在 主 回路 中 有 “控制 变压器 ”, 可 以 使 用 “控制 变压器 ”提供 的 DC24V 电源 。 

5. 触摸 屏 与 控制 器 的 连接 

触摸 屏 与 控制 器 直接 使 用 以 太 网 电缆 连接 。 其 连接 和 设置 参见 第 24 章 “ 触 摸 屏 在 机 器 
人 上 的 使 用 ”。 


2.9 机 器 人 系统 的 接地 


1. 接地 方式 

接地 是 一 项 很 重要 的 工作 ,接地 不 良 会 导致 烧毁 机 器 、 伤 人 或 干扰 引起 的 误 动作 ,所 以 
在 机 器 人 安装 连接 时 务必 接地 。 

(1) 接地 方式 有 如 图 2-17 所 示 的 三 种 方法 ,机 器 人 本 体 及 机 器 人 控制 器 应 尽量 采用 专 
用 接地 (图 2-17(a) ) 。 

(2) 接地 工程 应 采用 D 种 接地 (接地 电阻 100Q 以 下 ) ,以 与 其 他 设备 分 开 的 专用 接地 
为 最 佳 。 

(3) 接地 应 使 用 AWG #11(4.2mm?) 以 上 的 电线 。 接 地 点 应 尽量 靠近 机 器 人 本 体 , 控 
制 器 ,以 缩短 接地 用 电线 的 距离 。 


机 器 人 机 器 人 
机 同人 | | 控制 器 及 机 器 人 


机 器 人 
全 | | 控制 器 及 由 控制 器 及 
个 人 计算 机 个 人 计算 机 


i 


(a) 专用 接地 [最 佳 ] (b) 共用 接地 [ 良 ] (0) 公共 接地 [普通 ] 
2-17 机 器 人 的 接地 


2. 接地 要 领 
接地 线 的 连接 如 图 2-18 所 示 。 
M4X10 
弹簧 垫 加 Ye 
a 


平 垫圈 


二 ”本 体 接地 用 电缆 
(AWG #11(4.2mm2 以 上 ) 


2-18 机 器 人 接地 的 实际 接线 
接地 方法 如 下 。 


(1) 准备 接地 用 电缆 (AWG #11(4. 2mm2) 以 上 ) 及 机 器 人 侧 的 安装 螺栓 及 垫圈 。 注 


意 不 要 随意 使 用 面积 不 够 的 电线 ,否则 会 对 机 器 人 系统 造成 损害 。 


(2) 接地 螺栓 部 位 (A) 有 锈 或 油漆 的 情况 下 ,必须 通过 刍 刀 等 去 除 。 如 果 有 油漆 或 锈 


蚀 会 引起 接地 不 良 ,无 法 消除 干扰 信号 甚至 损坏 机 器 。 
(3) 将 接地 电缆 连接 到 接地 螺栓 部 位 。 


2.10 需要 思考 的 问题 


(1) 机 器 人 系统 如 何 连 接 外 部 1/O 信号 ? 
(2) 机 器 人 使 用 的 电源 有 哪些 等 级 ? 

(3) 什么 是 漏 型 接 法 ? 

(4) 什么 是 源 型 接 法 ? 

(5) 如 何 连 接 “ 工 作 模 式 选择 ”旋钮 开关 ? 
(6) 如 何 连 接 “ 急 停 ” 开 关 ? 
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第 3 章 ”第 3 日 一 一 使 工业 机 器 人 动 起 来 


【学 习 目 的 】 

第 3 日 的 学 习 内 容 是 “让 机 器 人 动 起 来 ”, 通 过 前 两 天 的 学 习 准 备 ,读者 应 该 已 经 了 解 了 
- 些 机 器 人 的 简单 知识 ,完成 了 机 器 人 的 连接 。 现 在 要 使 用 * 示 教 单元 ”使 机 器 人 动 起 来 , 破 
除 对 机 器 人 的 神秘 感 ,学习 使 用 示 教 单元 的 基本 方法 和 使 机 器 人 运动 到 指定 工作 位 置 点 的 
方法 。 


3.1 示 教 单元 及 其 各 按键 的 作用 


示 教 单元 也 称 为 “手持 式 操作 单元 ”, 由 于 常用 于 操作 机 器 人 确认 各 “位 置 点 ”, 所 以 一 般 
称 为 “ 示 教 单元 ”。 

操作 单元 有 许多 功能 ,正确 使 用 操作 单元 可 以 起 到 事半功倍 的 效果 。 

学 习 示 教 单元 上 各 按键 的 功能 是 很 有 必要 的 ,学习 者 必须 认真 学 习 , 多 做 实验 。 以 下 以 
三 菱 机 器 人 示 教 单元 R32-TB 为 例 进行 说 明 ,如 图 3-1 所 示 。 


©_ 


图 3-1 示 教 单元 各 按键 的 功能 


Q@ EMG. STOP 急 停 开 关 
在 任何 状态 下 (手动 或 自动 ) 按 下 本 开关 ,都 可 以 使 机 器 人 进入 * 急 停 状态 ”( 伺 服 一 


OFF) ,停止 一 切 运动 。 

@ TB ENABLE 使 能 开关 

本 开关 用 于 切换 示 教 单元 上 各 按键 的 有 效 / 无 效 状态 ,是 一 个 重要 而 且 常 用 的 开关 。 按 
下 TB ENABLE 开关 ,TB ENABLE 灯亮 ,表示 TB ENABLE== ON, 示 教 单元 操作 有 效 。 
同时 , 示 教 单元 操作 有 优先 权 , 其 他 外 部 设备 无 法 操作 机 器 人 。 

@ 使 能 开关 

本 开关 也 是 使 能 开关 。 在 “手动 模式 ”下 ,将 本 开关 拉 到 中 间 位 置 , 即 可 以 使 伺服 = 
ON ,而 本 开关 在 自由 位 置 和 * 拉 到 底 位 置 ?时 , 均 处 于 伺服 二 OFF 状态 ,所 以 也 称 为 “三 位 置 
开关 ”( 自 由 位 置 .中 间 位 置 . 拉 到 底 位置 ) ,是 对 示 教 单元 进行 多 重 保护 的 一 个 开关 。 

@ 显示 屏 

显示 屏 用 于 显示 相关 的 数据 。 

@ 显示 状态 灯 

POWER: 电源 灯 , 电 源 ON 时 ,POWER== 绿 灯 。 

ENABLE: 使 能 状态 灯 , 示 教 单元 有 效 时 ,ENABLE 一 绿灯 。 

SERVO: 伺服 系统 状态 灯 , 伺 服 系统 ON 时 ,SERVO= 绿 灯 。 

ERROR : 报警 状态 灯 , 机 器 人 出 现 报 警 时 ,ERROR 一 红 灯 。 

@ Fl1~F4 键 

F1 一 F4 键 用 于 选择 显示 屏 上 对 应 位 置 的 功能 , 称 为 功能 键 。 

@O FUNCTION 功能 键 

FUNCTION 功能 键 用 于 切换 显示 屏 上 的 功能 菜单 。 显 示 屏 最 下 部 一 次 只 能 显示 4 种 
功能 ,如 果 显 示 界 面 的 功能 多 于 4 个 ,使 用 FUNCTION 功能 键 进行 切换 。 

@ STOP 键 

STOP 键 用 于 停止 正在 运行 的 程序 ,使 运动 中 的 机 器 人 减速 停止 。 

Q@ OVRD 十 .OVRD 一 速度 信和 率 改 变 按键 

OVRD 十 .OVRD 一 速度 倍率 改变 按键 用 于 改变 “速度 倍率 ”。 

@@ JOG 操作 键 

JOG 操作 键 用 于 JOG 运行 时 指令 各 轴 的 运动 (X 十 ,X 一 ,C 十 ,C 一 )。 

加 SERVO 键 

SERVO 键 用 于 设置 伺服 系统 ONMOFF ,注意 在 三 位 置 使 能 开关 王 ON 时 才 有 效 。 

@@ MONITOR 键 

MONITOR 键 为 监视 模式 选择 键 。MONITOR 王 ON 时 , 示 教 单元 进入 监视 模式 ,可 监 
视 机 器 人 系统 的 运动 状态 。 

JOG 键 

JOG 模式 选择 键 。JOG 二 ON 时 ,系统 进入 JOG 状态 ,可 以 进行 各 种 JOG 操作 。 这 是 
最 常用 的 一 个 按键 。 

四 HAND 键 

HAND 键 为 抓 手 模式 选择 键 。 

四 CHARACTER 键 

CHARACTER 键 为 数字 /文字 切换 键 ,用 于 切换 输入 时 是 数字 还 是 文字 。 
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四 RESET 复位 键 

RESET 复位 键 用 于 解除 报警 状态 。 同 时 按 下 RESET 十 EXE 键 可 执行 程序 复位 。 
@@ 光标 键 

@@ CLEAR 删除 键 

CLEAR 删除 键 用 于 删除 光标 所 在 位 置 的 内 容 。 

四 EXE 执行 键 

EXE 执行 键 用 于 对 输入 的 内 容 进行 确认 。 

连续 按 EXE 键 ,机 器 人 会 动作 。 

四 数字 /文字 键 

数字 /文字 键 用 于 输入 数字 或 文字 。 


3.2 如何 使 机 器 人 动 起 来 


在 学 习 了 解 了 示 教 单元 上 各 个 按键 的 作用 之 后 ,现在 的 任务 是 让 机 器 人 动 起 来 ,以 破除 
初学 者 对 机 器 人 的 神秘 感 。 

让 机 器 人 动 起 来 的 步骤 如 下 。 

(1) 将 机 器 人 本 体 与 控制 器 正常 连接 。 

(2) 将 示 教 单元 连接 于 控制 器 上 。 

(3) 暂时 不 连接 其 他 输入 输出 信号 和 操作 面板 。 

(4) 检查 安全 完毕 后 上 电 。 

(5) 将 TB ENABLE 开关 按 下 ,确认 TB ENABLE 灯亮 ,这 时 示 教 单元 为 有 效 状 态 。 

(6) 将 三 位 置 使 能 开关 轻 拉 至 中 间 位 置 并 保持 在 该 位 置 。 

(7) 按 下 SERVO 按键 ,等 待 SERVO 绿灯 亮 。 稍 后 可 听见 “ 滴 ” 一 声 , 表 示 机 器 人 伺服 
系统 二 ON。 

(8) 选择 “速度 倍率 OVRD”==10%。 

(9) 观察 机 器 人 本 体 的 位 置 ,确保 机 器 人 动作 范围 内 无 障碍 物 。 

(10) 按 下 JOG 键 , 选 择 JOG 模式 (按键 13) 。 
注意 : 现在 已 经 进入 JOG 模式 ,必须 注意 安全 动作 。 
(11) 以 “点 动 ” 方 式 ,逐一 按 下 JI 一 J6 键 ,观察 机 器 人 的 动作 。 
如 果 机 器 人 能 够 正常 运行 ,就 达到 了 第 一 阶段 的 目的 。 


3.3 学 习 操作 各 种 JOG 模式 
机 器 人 不 同 于 其 他 “运动 控制 器 ”的 特点 之 一 就 是 ,即使 是 在 JOG 模式 下 ,也 有 很 多 类 
型 的 JOG 动作 ,这 取决 于 采用 的 不 同 的 “坐标 系 ”。 
3.3.1 关节 型 JOG 


1. 关节 型 JOG 
如 图 3-2 所 示 以 关节 轴 为 对 象 ,以 角度 为 单位 实行 的 “点 动 操作 ”就 是 关节 型 JOG, 可 以 


对 1 一 J6 轴 分 别 执行 JOG 操作 。 
5 2. 操作 步 又 
(1) 将 TB ENABLE 开关 按 下 ,确认 TB ENABLE 

灯亮 ,这 时 示 教 单元 为 有 效 状态 。 

(2) 将 “三 位 置 使 能 开关 ” 轻 拉 至 中 间 位 置 并 保持 在 
该 位 置 。 

(3) 按 下 SERVO 按键 ,等 待 SERVO 绿灯 亮 。 稍 后 
可 听见 “ 滴 ” 一 声 , 表 示 机 器 人 伺服 系统 ==ON。 

(4) 按 下 JOG 键 ,选择 JOG 模式 (按键 13) 。 

(5) 根据 显示 屏 上 最 下 排 的 显示 , 按 下 F1 一 F4 键 ， 
(选择 “ 直 交 ”)。 
3-2 关节 型 JOG 示意 图 (6) 以 “点 动 ”方式 ,逐一 按 下 X、Y、Z、A、B、C 按键 ， 

观察 机 器 人 的 动作 。 


+J5 


3.3.2 直 交 型 JOG 


1. 模式 

在 直 交 型 JOG 中 ,以 如 图 3-3 所 示 的 坐标 系 为 基准 , 即 以 “世界 坐标 系 ”为 基准 ,机 器 人 
控制 点 在 X/Y/Z 方 向 上 以 mm 为 单位 运动 。 而 A/B/C 轴 
的 运动 则 是 旋转 运动 ,以 角度 为 单位 。 在 旋转 时 ,机 器 人 控 
制 点 位 置 不 变 , 抓 手 的 方位 改变 。 

2. 操作 步 县 

(1) 将 TB ENABLE 开关 按 下 ,确认 TB ENABLE 灯 
亮 ,这 时 示 教 单元 为 有 效 状 态 。 

(2) 将 “三 位 置 使 能 开关 ” 轻 拉 至 中 间 位 置 并 保持 在 该 
位 置 。 

(3) 按 下 SERVO 按键 。 等 待 SERVO 绿灯 亮 。 稍 后 
可 听见 “ 滴 ” 一 声 , 表 示 机 器 人 伺服 系统 二 ON。 

(4) 按 下 JOG 键 ,选择 JOG 模式 (按键 13)。 

(5) 根据 显示 屏 上 最 下 排 的 显示 , 按 下 Fl1~F4 键 ( 选 择 “ 直 交 ”)。 

(6) 以 “点 动 ”方式 ,逐一 按 下 X、Y、Z、A、B、C 按键 ,观察 机 器 人 的 动作 。 


3.3.3 TOOL 型 JOG 


1. 模式 

TOOL 型 JOG 就 是 以 “TOOL 坐标 系 ”为 基准 进行 的 JOG 运行 ,如 图 3-4 所 示 。 

这 种 TOOL 型 JOG 以 “TOOL 坐标 系 ? 为 基准 ,在 TOOL 坐标 系 的 X/Y/Z 方向 做 直 
线 运动 ,单位 为 mm。 在 A/B/C 轴 方 向 做 旋转 运动 ,以 角度 为 单位 。 

TOOL 型 JOG 与 直 交 型 JOG 的 不 同 就 是 依据 的 坐标 系 不 同 , 所 以 使 用 时 要 预先 设置 
MEXTL 参数 ,也 就 是 预先 设置 TOOL 坐标 系 。 


图 3-3 直 交 型 JOG 示意 图 


地 ww 加 


第 3 日 一 一 使 工业 机 器 人 动 起 来 


30 日 学 凤 工 业 机 器 人 


3-4 TOOL 型 坐标 系 示意 图 


2. 操作 步 又 

(1) 将 TB ENABLE 开关 按 下 ,确认 TB ENABLE 灯亮 ,这 时 示 教 单元 为 有 效 状 态 。 

(2) 将 “三 位 置 使 能 开关 ” 轻 拉 至 中 间 位 置 并 保持 在 该 位 置 。 

(3) 按 下 SERVO 按键 ,等 待 SERVO 绿灯 亮 。 稍 后 可 听见 “ 滴 ” 一 声 , 表 示 机 器 人 伺服 
系统 = 二 ON。 

(4) 按 下 JOG 键 ,选择 JOG 模式 (按键 13)。 

(5) 根据 显示 屏 上 最 下 排 的 显示 , 按 下 F1 一 F4 键 ( 选 择 TOOL) 。 

(6) 以 “点 动 ”方式 ,逐一 按 下 X、Y、Z、A、B、C 按键 ,观察 机 器 人 的 动作 。 


3.3.4 三 轴 直 交 型 JOG 


1. 模式 

三 轴 直 交 型 JOG 在 X/Y/Z 方 向 上 是 以 “世界 坐标 系 ” 为 基准 ,移动 单位 是 mm。 但 是 
A/B/C 三 轴 的 移动 则 是 对 应 J4/J5/J6 轴 , 以 角度 为 单位 ， 4 
如 图 3-5 所 示 。 这 种 方式 综合 了 两 种 坐标 系 的 优势 。 

2. 操作 步 桑 +15 


(1) 将 TB ENABLE 开关 按 下 ,确认 TB ENABLE 灯 
亮 , 这 时 示 教 单元 为 有 效 状态 。 Kg 

(2) 将 “三 位 置 使 能 开关 ” 轻 拉 至 中 间 位 置 并 保持 在 该 。” /~ 
位 置 。 

(3) 按 下 SERVO 按键 ,等 待 SERVO 绿灯 亮 。 稍 后 
可 听见 “ 滴 ” 一 声 ,表示 机 器 人 伺服 系统 二 ON。 

(4) 按 下 JOG 键 ,选择 JOG 模式 (按键 13) 。 

(5) 根据 显示 屏 上 最 下 排 的 显示 , 按 下 F1 一 F4 键 ( 选 图 3-5 三 轴 直 交 型 JOG 示意 图 
择 “ 三 轴 直 交 ”) 。 

(6) 以 “点 动 ” 方 式 ,逐一 按 下 X\Y、Z、A、B、C 按键 ,观察 机 器 人 的 动作 。 


3.3.5 圆 简 型 JOG 


1. 模式 
圆 简 型 JOG 首先 要 建立 一 个 圆 简 型 坐标 系 。 如 图 3-6 所 示 ,在 圆 简 型 坐标 系 中 ,X 坐 


标 表示 圆 简 的 半径 ,2Z 坐标 表示 圆 简 的 高 度 ,Y 坐标 表示 圆 简 的 旋转 角度 (也 就 是 Jl 轴 的 角 


度 ) 。 其 余 A/B/C 轴 的 旋转 方向 如 图 3-6 所 示 。 这 样 圆 简 
型 JOG 就 相当 于 机 器 人 控制 点 在 一 个 圆 简 壁 上 做 运动 。 
或 者 说 ,如 果 是 一 个 圆 简 壁 上 的 运动 ,就 选取 圆 简 型 JOG 
最 为 适宜 。 

2. 操作 步 县 

(1) 将 TB ENABLE 开关 按 下 ,确认 TB ENABLE 灯 
亮 。 这 时 示 教 单元 为 有 效 状态 。 

(2) 将 “三 位 置 使 能 开关 ? 轻 拉 至 中 间 位 置 并 保持 在 该 
位 置 。 

(3) 按 下 SERVO 按键 ,等 待 SERVO 绿灯 亮 。 稍 后 
可 听见 “ 滴 ” 一 声 , 表 示 机 器 人 伺服 系统 二 ON 。 

(4) 按 下 JOG 键 ,选择 JOG 模式 (按键 13) 。 

(5) 根据 显示 屏 上 最 下 排 的 显示 , 按 下 F1 一 F4 键 ( 选 
择 “ 圆 简 JOG”) 。 


图 3-6 圆 简 型 坐标 系 


(6) 以 “点 动 ” 方 式 ,逐一 按 下 X、Y、Z、A、B、C 按键 ,观察 机 器 人 的 动作 。 


3.3.6 工件 型 JOG 
1. 模式 


工件 型 JOG 就 是 以 工件 坐标 系 进行 的 点 动 操作 。 事 实 上 ,如 果 要 做 轨迹 型 的 运动 , 工 
件 的 图 纸 是 已 经 设计 完毕 的 。 工 件 的 安装 与 机 器 人 的 相对 位 置 也 是 固定 的 。 工 件 坐标 系 如 
图 3-7 所 示 , 所 以 工件 JOG 就 是 沿 着 工件 坐标 系 进行 的 JOG 运动 ,与 直 交 型 JOG 相同 ,只 


是 坐标 系 位 置 不 同 。 
机 器 人 控制 点 在 X/Y/Z 方向 上 以 mm 为 单 
i 位 运动 。 而 A/B/C 轴 的 运动 则 是 旋转 运动 ,以 
一 角度 为 单位 。 


保持 在 该 位 置 。 


坐标 系 


工件 二 
对 准 工件 或 作业 台 等 的 坐标 系 。 统 二 ON 。 


2. 操作 步 又 

(1) 将 TB ENABLE 开关 按 下 ,确认 TB 
ENABLE 灯亮 ,这 时 示 教 单元 为 有 效 状 态 。 

(2) 将 “三 位 置 使 能 开关 " 轻 拉 至 中 间 位 置 并 


p> (3) 按 下 SERVO 按键 ,等 待 SERVO 绿灯 
亮 , 稍 后 可 听见 ” 


滴 ” 一 声 ,表示 机 器 人 伺服 系 


图 3-7 工件 型 JOG 示意 图 (4) 按 下 JOG 键 ,选择 JOG 模式 (按键 13)。 
(5) 根据 显示 屏 上 最 下 排 的 显示 , 按 下 Fl 一 


F4 键 ( 选 择 “ 工 件 JOG”)。 


(6) 以 "点 动 ” 方 式 ,逐一 按 下 X、Y、Z、A、B、C 按键 ,观察 机 器 人 的 动作 。 


第 3 日 一 一 使 工业 夫 器 人 动 起 来 


击 必 溃 


30 日 学 嵌 工 业 机 器 人 


3.4 需要 思考 的 问题 


(1) 使 用 示 教 单元 进行 JOG 运行 的 基本 步骤 有 哪些 ? 
(2) 什么 是 关节 型 JOG? 
(3) 什么 是 直 交 型 JOG? 


第 4 童 。 第 4 日 一 使 用 示 教 单元 进行 
编程 .调试 及 设置 参数 


【学 习 目 的 】 

第 4 日 的 学 习 内 容 是 对 示 教 单元 功能 的 深度 学 习 , 要 充分 理解 “ 示 教 单元 ”的 丰富 功能 。 
即使 在 没有 计算 机 的 情况 下 ,只 要 有 “ 示 教 单元 "就 可 以 进行 编程 .调试 ,设置 参数 ,驱动 机 器 
人 正常 运行 。 


4.1 示 教 单元 的 “ 整 列 ” 功 能 


1. 功能 

“ 整 列 ?功能 就 是 使 机 器 人 的 抓 手 就 近 回 到 距离 “当前 位 置 ?最 靠近 的 90" 方 向 ,如 图 4-1 
所 示 。 在 实际 应 用 中 ,如 果 需 要 抓 手 迅速 对 准 工 件 , 这 是 一 种 快捷 的 方法 。 

(1) 如 果 没 有 设置 “TOOL 坐标 系 ”, 经 过 “ 整 列 ” 后 , 抓 手 就 到 达 图 中 的 前 一 个 位 置 。 

(2) 如 果 设 置 了 “TOOL 坐标 系 ”, 经 过 “ 整 列 ” 后 , 抓 手 就 到 达 图 中 的 后 一 个 位 置 。 

可 以 看 到 是 以 “控制 点 ”为 基准 ,“ 控 制 点 "位 置 不 变 , 抓 手 的 位 置 发 生 改变 。 

2. 操作 步 又 

(1) 选择 “手动 模式 ”。 

(2) 将 TB ENABLE 开关 按 下 ,确认 TB ENABLE 灯亮 ,这 时 示 教 单元 为 有 效 状 态 。 

(3) 将 “三 位 置 使 能 开关 ” 轻 拉 至 中 间 位 置 并 保持 在 该 位 置 。 

(4) 按 下 SERVO 按键 ,等 待 SERVO 绿灯 亮 。 稍 后 可 听见 “ 滴 ” 一 声 ,表示 机 器 人 伺服 
系统 二 ON。 

(5) 按 下 HAND 键 ,显示 “ 抓 手 ”界面 如 图 4-2 所 示 。 


有 指定 无 指定 入 


无 指定 有 指定 
a rR 区 a 工具 坐标 
也 
ee 
二 三 入 | 
/ 
控制 点 控制 点 一 


图 4-1 整 列 位 置 示意 图 


30 日 学 烧 工 业 机 器 人 


(6) 按 下 并 保持 ( 按 下 ) 对 应 “ 整 列 ” 功 能 的 F2 键 ,机 器 人 动作 ,执行 “ 整 列 ” 动 作 。 


4.2 程序 编辑 


示 教 单元 的 重要 功能 之 一 是 可 以 编辑 程序 ,不 使 用 “编程 软件 ”也 可 以 完成 程序 编辑 的 
相关 任务 。 相 关 的 指令 可 在 后 续 章 节 学 习 。 

以 下 是 编辑 程序 的 步骤 。 

(1) 上 电 后 , 按 EXE 键 进入 菜单 界面 ,选择 进入 “管理 /编辑 "界面 。 

(2) 按 下 对 应 "新建 ”功能 的 F3 键 ,进入 如 图 4-3 所 示 界 面 。 

《车 理 /编辑 》1/6 
100 07-05-30 20:21:30 485 
101 07-05-30 20:21:40 485 《新 建 程序 》 

条 


102 07-05-30 20:21:50 485 Co> 旦 序 名 
103 07-05-30 20:21:55 485 


) 


( 
编辑 ] [位置 ] [123 ] [ 新建 ] [复制 | NE 


图 4-3 新 建 一 个 程序 
(3) 输入 程序 名 , 按 EXE 键 ,进入 如 图 4-4 所 示 指 令 编 辑 界面 。 


“新 建 程序 > 
程序 名 = 《程序 》 1 100% 
pe 
( 1 ) 
| WH 7 WM 7 I Le ji 


图 4-4 对 新 程序 命名 
(4) 进入 指令 编辑 。 以 输入 以 下 程序 为 例 : 


1 MovPl 
2 MovP2 
3 End 


Q@ 按 下 对 应 “插入 ”功能 的 F3 键 ,进入 “插入 编辑 ”状态 ,如 图 4-5 所 示 。 


《程序 》 1 100% ==> < 程序 》 1 INS 


编辑 ] [ 删除 ] [ 123 ] [ 插入 ][ 示 教 | | “有 EEC ES 


图 4-5 程序 输入 编辑 界面 


@ 输入 “ 步 序 号 ”; 按 CHARACTER 键 ,选择 数字 输入 ,输入 数字 “1”, 进 入 如 图 4-6 所 


人 程序》 1 INS [a < 程序 》1 INS 


mm EM 7) MM 7 mm | 7 x 


图 4-6 程序 步 序 号 输入 编辑 界面 
@ 输入 MOV P1” 指 令 。 注 意 在 “MOV” 和 “P1” 之 间 有 空格 ,如 图 4-7 所 示 。 


《程序 


1 MOV 


El Em 关 间 


图 4-7 程序 输入 界面 
@ 输入 程序 的 确认 。 
在 输入 了 程序 指令 后 ,还 要 进行 “确认 ”操作 , 即 对 输入 的 程序 指令 进行 确认 。 操 作 如 下 。 
选 定 程序 行 (例如 选择 1 MOV P1 ) 一 按 EXE 键 。 


如 图 4-8 所 示 光 标 移 到 下 一 行 。 同 样 的 操作 ,可 以 对 所 有 的 程序 行进 行 确认 。 
《程序 > 1 INS 《程序 》 1 100% 
1 MOV P1 1 MOV Pi 
= | 
| 12: | 国有 | 关 六 编辑 ] | 删除 | [ 123 插入 | [ 示 教 


图 4-8 程序 输入 确认 界面 


@ 编制 程序 结束 。 
在 编制 程序 结束 后 , 按 “ 关 闭 ” 键 , 回 到 上 一 级 菜单 “管理 /编辑 ”", 如 图 4-9 所 示 。 


《管理 /编辑 》 1/6 
< 程序 》 1 100% 1 07-05-30 20:21:30 485 
1 MOV P1 2 07-05-30 20:21:40 485 
2 MOV_P2 3 07-05-30 20:21:50 485 
END | 4 07-05-30 20:21:55 485 
直接 ] [切换 ] [zs 关闭 编辑 ] [位置 | [123 | [ 新 建 ] [复制 


图 4-9 回 到 上 一 级 菜单 “管理 /编辑 ” 


圩 会 收 


第 4 日 一 一 使 用 示 载 单元 进行 编程 ,调试 及 设置 参 才 


30 日 学 嵌 工 业 机 器 人 


4.3 程序 修正 


程序 修正 是 经 常 性 的 工作 ,程序 修正 方法 步 又 如 下 。 
例如 ,将 “MOV P5” 修 改 为 “MVS P5”。 

(1) 进入 需要 修改 的 程序 界面 。 

(2) 选择 需要 修改 的 程序 行 (5 MOV P5)。 

(3) 按 下 “编辑 ? 键 , 进 入 “修改 ?界面 ,如 图 4-10 所 示 。 


< 程序 > 
《程序 > 1 100% “程序 》 1 Edit 
3 5 MOV P5 
5.MOV P5 
6 END 
编 闪 ] | 夫 | | 123 | | 手 入 | [ 示 攻 编 办 ] [列队 ] [ 123 ] [所 入 | [到 


图 4-10 程序 修改 界面 
(4) 输入 MVS 指令 ,再 按 下 EXE 键 ,确认 修改 完成 ,如 图 4-11 所 示 。 


《程序 > 1 Edit 


《< 程序 > 1 100% 


5 MOV P5 


图 4-11 程序 修改 完成 界面 
(5) 按 “ 关 闭 ” 键 ,保存 修改 的 程序 。 


4.4 示 教 操作 


本 操作 就 是 要 将 “当前 位 置 点 ”设置 为 自动 程序 中 的 一 个 “工作 点 ”"。 这 是 示 教 单元 最 重 
要 的 工作 之 一 。 在 实际 工作 中 ,可 以 观察 到 机 器 人 的 工作 点 位 置 ( 例 如 Pl 点 或 P2 点 ), 但 
具体 的 坐标 数值 不 知道 。 利 用 JOG 功能 ,将 机 器 人 直接 移动 到 Pl1 点 ,在 显示 屏 上 就 可 以 读 
出 Pl 点 的 数据 ,同时 就 可 以 将 “当前 点 ?设置 为 程序 中 的 Pl 点 。 这 个 过 程 就 是 “ 示 教 ”。 

示 教 操作 如 下 (以 P5 点 为 例 ) 。 

(1) 在 “指令 编辑 ”界面 进行 的 示 教 操作 。 

Q@ 使 用 JOG 功能 ,将 机 器 人 直接 移动 到 (预定 的 )P5 点 ,并 在 显示 屏 上 观察 “当前 点 ”的 
数据 。 

@ 在 “指令 编辑 ”界面 选择 程序 行 “5 MOV P5”。 

@ 选择 按 下 对 应 “ 示 教 ”功能 的 按键 F4, 进 入 “ 示 教 确认 ”界面 ,如 图 4-12 所 示 。 

@ 按 下 “是 ”按键 ,“ 当 前 位 置 点 ”被 设置 为 P5 点 。 同 时 返回 “上 一 级 程序 编辑 "界面 ,如 
图 4-13 所 示 。 


《< 程序》 1 
《程序 > 1 100% 程序 
4 MOV P4 F5 
5.MOV P5 
5 END me。 是 否 记录 当前 位 置 ? 
编辑 | | 删除 | [ 123 插入 | [ 示 教 ] 是 ] 123 天 
图 4-12 进入 “ 示 教 确认 ”界面 
《程序 》 1 i 
i 《程序 》 1 100% 
P5 
5.MOV_P5 
是 否 记录 当前 位 置 ? = 6 END 
是 123 [ED 编辑 | [ 删除 | [ 123 插入 | [ 示 教 ] 


图 4-13 示 教 点 确认 
@ 示 教 操作 完成 。 
(2) 在 “位 置 编辑 界面 进行 的 示 教 操作 。 
“位 置 编辑 "界面 是 专门 对 各 * 工 作 位 置 点 ”进行 编辑 的 界面 。 可 以 在 “位 置 编 辑 ” 界 面 调 
出 各 “工作 位 置 点 ”, 利 用 示 教 功能 进行 设置 。 


操作 步骤 如 下 。 
Q@ 使 用 JOG 功能 ,将 机 器 人 直接 移动 到 (预定 的 )P5 点 ,并 在 显示 屏 上 观察 “当前 点 ”的 
数据 。 
@ 在 "指令 编辑 ”界面 按 下 切换 键 进 入 "位 置 编辑 界面 ,如 图 4-14 所 示 。 
《程序 > 1 100% 《位 置 编辑 > 关节 100% P2 
1 MOV P1 X+0.00 A: +0.00 
2 MOV P2 Yi:+0.00 B+0.00 
3 MOV P3 Z+0.00 C: +0.00 
‘uo md 
前 进 跳 转 123 后 退 移动 示 教 | [ 123 上 一 个 ] [于 = 个 
4-14 进入 “位置 编辑 "界面 
@ 使 用 * 上 一 个 “下 一 个 ”按键 调 出 P5 点 ,如 图 4-15 所 示 。 
《位置 编辑 > 关节 100% P2 《< 位置 编 辑 > 关节 100% P5 
X+0.00 A: +0.00 X+0.00 A: +0.00 
Y:+0.00 B+0.00 Y¥:+0.00 B+0.00 
wa eb) 
FL1: 0 FL2: 0 FL1: 0 FL2: 0 
移动 |[ 示 教 | [ 123 上 一 个 | [二 -个 移动 |[ 示 教 13 1} [LE 个 |] 二 -十 


图 4-15 调 出 P5 点 
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@ 按 下 对 应 “ 示 教 ”功能 的 按键 F2, 进 入 “ 示 教 确认 ”界面 ,如 图 4-16 所 示 。 


< 位 置 编辑 > 关节 100% P5 《位 置 编辑 ”< 位 置 > 
X+0.00 A: +0.00 Ea 
Y:+0.00 B+0.00 
Z+0.00 C: +0.00 是 五 记录 当前 位 置 ? 
L1: +0.00 L210.00 mw 是 否 记录 当前 位 置 ? 
FL1: 0 FL2: 0 
移动 示 教 123 上 一 个 | = 个 ] 是 123 理 


图 4-16 进入 “ 示 教 确认 ”界面 
加 按 下 是" 按键， 当前 位 置 点 "被 设置 为 P5 点 ,如 图 4-17 所 示 。 


《位置 编辑 > 


P5 


《位 置 编辑 > 关节 100% P5 


X+997.00 A--180-.00 
Y:+0.00 B: + 89.00 
Z+928.24.00 C: :180.00 
L1: +0.00 

FL1 0 


移动 || 示 教 


是 否 记 录 当 前 位 置 ? 


L2 ;0.00 
FL2: 0 


a 


是 


123 


4-17 设置 P5 点 
@ 示 教 操作 完成 。 


4.5 向 预先 确定 的 位 置 移动 
在 实际 现场 ,可 能 出 现 要 求 机 器 人 往 一 个 "确定 的 点 "运动 。 例 如 ,对 一 个 点 进行 反复 的 
调整 。 
使 用 * 示 教 单元 "可 以 实现 这 一 要 求 。 操 作 步骤 


《位 置 编辑 > 关节 30% P1 
i X+997.00 A:-180-.00 
(1) 伺服 ON。 Y:+0.00 B: + 89.00 
Z+928.24.00 C:+180.00 
(2) 进入 “位 置 编辑 "界面 , 调 出 预想 位 置 点 ,图 eo 二 20 的 
中 为 Pl 点 ,如 图 4-18 所 示 。 rr 


(3) 按 住 对 应 “移动 "功能 的 Fl 键 ,直到 机 器 人 


移动 到 该 位 置 Pl 点 。 图 4-18 调 出 预想 位 置 点 


4.6 位置 数据 的 MDI( 手 动 数据 输入 ) 


如 果 需 要 调整 “位 置 点 的 某 一 轴 数 据 ”, 可 以 使 用 MDI 功能 。MDI 即 “ 手 动 数 据 输入 ”。 
操作 如 下 (修改 P50 点 数据 )。 

(1) 进入 “位 置 编辑 "界面 , 调 出 P50 点 ,如 图 4-19 所 示 。 

(2) 在 Z 位 置 输入 “50” 后 按 EXE 键 ,如 图 4-20 所 示 。 

(3) 修改 完成 。 


< 程序 》 1 100% 二 
《位 >》 关节 100% 
ee 位 置 编辑 > 关节 100% P50 
X+0.00 A: + 0.00 
3 Ms m= Y:+0.00 B: + 0.00 
Z+0.000 C: 0.00 
4 MOV P4 L1: +0.00 L2:0.00 
FL1: 0 FL2: 0 
直接 | | 切换 | | 123 关闭 移动 || 示 教 | [ 123 ] [上 个 | [F 一 个 
4-19 调 出 P50 点 
《位 置 编辑 》 关节 100% P50 《位 置 编 辑 》 关节 100% P50 
X +0.00 A: + 0.00 X+0.00 A: +0.00 
Y: +0.00 B: + 0.00 Y:+0.00 B: + 0.00 
Zz: +50.000 C: 0.00 es Z.+50.000 C: 0.00 
L1: +0.00 L2:0.00 L1: +0.00 L2:0.00 
FL1: 0 FL2: 0 FL1: 0 FL2: 0 
移动 示 教 123 上 一 个 下 一 个 移动 示 教 123 ] 上 -个 | [下 不 


4-20 Z 位 置 输入 *50” 


4.7 调试 功能 


使 用 示 教 单元 也 可 以 进行 程序 调试 。 
4.7.1 单 步 运行 


单 步 运行 是 程序 调试 中 最 常用 的 功能 。 操 作 步 又 如 下 。 
(1) 按 “ 菜 单 ”>“ 管 理 / 编 辑 ” 一 “编辑 ” 键 ,进入 “程序 ”编辑 界面 ,如 图 4-21 所 示 。 


《程序 》 1 100% 《程序 》 1 100% 
和 MOV _P1 1 MOV_P1 
2 MOV P2 2 MOV P2 
3 MOV P3 PE 3 MOV P3 
4 MOV P4 4 MOV P4 
[Cr 进 ] [ 跳 转 |] [23] | | 前 进 | [ 跳 转 | [123 后 运 


图 4-21 进入 “程序 ”编辑 界面 
(2) 按 下 对 应 “前 进 ” 功 能 的 Fl 键 ,系统 执行 “光标 所 在 的 程序 行 ”后 ,停止 。 
(3) 每 按 一 次 “前 进 " 键 , 单 步 执 行 一 个 “程序 行 ”。 
4.7.2 程序 送 向 运行 
一 般 程序 运行 是 按 程序 行 号 顺 向 运行 的 。 在 下 面 的 程序 中 ,程序 运行 的 顺序 是 P1-P2- 
P3-P4。 


必 WwW Nb 
EE 
© 
= 
吕 


击 玉 疏 
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而 程序 逆向 运行 则 是 运行 到 P4 点 后 ,再 一 步 一 
步 按 P4-P3-P2-P1 顺序 逆向 运行 ,如 图 4-22 所 示 。 


操作 步骤 如 下 。 


程序 当前 行 已 经 是 “4 MOYV P4”, 到 达 了 P4 点。 


(1) 进入 “程序 ”编辑 界面 ,如 图 4-23 所 示 。 
(2) 按 下 对 应 “后 退 ” 功 能 的 F4 键 ,直到 程序 执行 


到 第 3 行 *3 MOV P3”。 


4-22 北向 运行 示意 图 


(3) 每 按 下 对 应 “后 退 ” 功 能 的 F4 键 ,程序 后 退 一 行 。 


P4 


《程序 > 1 100% 《程序 》 1 100% 

1 MOV P1 四 MOV P1 

2 MOVP2 2 es 

3 MOV P3 = 3 

4 MOV P4 4 MOV P4 

前 进 | [ 跳 转 | [ 123 后 退 ] 前 进 | [ 跳 转 | [ 123 ] [LE 过 
图 4-23 进入 “程序 ”编辑 界面 
4.7.3 跳 转 


如 果 希 望 执 行 某 一 指定 的 程序 行 ,可 以 直接 从 当前 行 转 到 指定 行 ,这 就 是 跳 转 功能 。 操 


作 如 下 。 


(1) 进入 “程序 ”编辑 界面 ,如 图 4-24 所 示 。 


《程序 > 1 100% 
1 MOV P1 
2 MOV P2 


3 MOV P3 
4 MOV P4 


sy 


《程序 > 1 


步 编号 (5) 


前 进 


[ 卡 转 


123 


后 退 ] 


] 123 ] 


关闭 


4-24 ”进入 “程序 ”编辑 界面 


(2) 按 下 对 应 跳 转 功能 的 F2 键 , 进 入 跳 转 程序 行 号 确认 界面 ,如 图 4-25 所 示 。 
(3) 设置 希望 跳 转 的 程序 行 号 (例如 : 程序 行 号 二 5)。 


(4) 光标 跳 到 第 5 步 程序 行 。 


(5) 按 下 “前 进 ” 功 能 键 ,程序 单 步 执行 。 


《程序 》 1 100% < 程序 > 1 100% 
4 MOV P4 4 MOV P4 
5 MOV PS 5 MOV P5 
6 MOV P6 > [6 MovP6 |] 
7 MOV P7 7 MOV P7 
前 进 | | 跳 转 | [ 123 后 退 前 进 | | 跳 转 ] [123 后 退 


4-25 按 下 对 应 “ 跳 转 ”功能 的 F2 键 


4.8 示 教 单元 的 高 级 编程 管理 功能 


示 教 单元 作为 一 个 完善 的 “手持 操作 器 ”, 具 备 丰富 的 操作 功能 ,本 节 将 全 部 介绍 。 在 第 
4 日 的 学 习 中 ,不 必 全 部 阅读 。 可 以 在 后 面 学 习 了 相关 的 程序 指令 及 参数 等 内 容 之 后 ,再 来 
参考 本 节 的 学 习 。 


4.8.1 管理 和 编辑 (程序 ) 


本 功能 是 建立 新 的 运动 程序 或 对 原 有 的 程序 进行 编辑 ,具有 下 列 功 能 。 
(1) 建立 一 个 新 的 程序 ; 
(2) 编辑 原 有 程序 ; 
(3) 编辑 "位 置 点 ”; 
(4) 复制 程序 ; 
(5) 重新 命名 程序 ; 
(6) 删除 程序 ; 
(7) 保护 程序 。 
具体 操作 参看 图 4-26 。 
主 菜单 画面 


《菜单 > 
1 管理 /编辑 2 运行 EXE 
3. 参数 4. 原 点 /制动器 开机 夯 面 


5. 设 定 /初始 化 6. 扩展 功能 关闭 


已 呈 D [如 号 cm 


1. 管理 /编辑 菜单 画面 


《管理 /编辑 》 ”1/6 程序 名 输入 画面 


[EJ] 加 ] 


程序 编辑 画面 
[要 要 DIE V2) CE 二 一 


图 4-26 主 菜单 


第 14 日 一 一 使 用 示 载 单元 进行 编程 ,调试 及 设置 参 阁 
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位 置 编辑 画面 


CED CI ED [一 


复制 程序 画面 


[mw [mm Co Mm | E37 | 


程序 重新 命名 画面 


删除 程序 画面 


程序 保护 画面 


[me | we Wm 反思 


图 4-26 ( 续 ) 


4.8.2 运行 


本 功能 用 于 运行 一 个 选 定 的 程序 ,如 图 4-27 所 示 。 

1. 确认 操作 

确认 用 于 执行 某 一 程序 行 的 动作 ,确认 该 程序 行 是 否 正确 ,是 否 到 达 预 定 的 位 置 。 
确认 操作 界面 有 以 下 功能 。 

(1) 前 进 一 一 按 顺 序 选择 程序 行 。 

(2) 跳 转 一 一 跳 转 到 指定 的 程序 行 。 

(3) 后 退 一 一 反 向 运行 。 

2. 测试 运行 一 一 对 选择 的 程序 进行 测试 

有 “连续 运行 模式 ”和 “循环 运行 模式 ”两 种 模式 。 


2.“ 运 行 " 界 面 “确认 ?界面 


《确认 > SLOT1 1SOL 100% 
1 MOV P1 

2 MOV P2 

3 MOV P3 


4 MOV P4 
LDLDP CD] 区 | 


“测试 运行 "界面 


< 测试 运行 > 
程序 名 ;1 


模式 : 循环 


DD Ba Eg 


图 4-27 “运行 "界面 


4.8.3 参数 的 设置 修改 
本 界面 功能 用 于 设置 和 修改 参数 ,如 图 4-28 所 示 。 


2.“ 运 行 "界面 
《运行 > 
1. 确认 2， 测 试 运行 
135 关闭 
3 参数 "界面 
《参数 > 参数 名 () 
数据 要 素 () 
( ) 
数据 | [上 一 | [123 ] | 下 一 ] [关闭 


图 4-28 “参数 ”界面 


第 4 日 一 一 使 用 示 载 单元 进行 编程 ,调试 及 设置 参 烙 


地上 洪 
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4.8.4 原点 设置 /制动器 设置 
本 界面 用 于 设置 原点 和 制动器 ,如 图 4-29 所 示 。 
(1) 原点 设置 : 设置 原点 有 6 种 方法 (参见 30. 5. 1 节 )。 
(2) 制动器 设置 : 制动器 设置 就 是 是 否 解除 各 伺服 电机 的 抱 闸 功能 。 由 于 解除 抱 兽 有 
危险 ,可 能 导致 机 器 人 某 个 轴 上 坠落 ,所 以 必须 特别 小 心 。 
4.“ 原 点 /制动器 "界面 “原点 设 定 "界面 


《原点 /制动器 > 《原点 设 定 > 

1， 数据 2. 机 械 限 位 器 
3， 工具 4. ABS 
5. 用 户 


中 口 四 加 加 


“解除 制动器 "界面 


《解除 制动器 > 
J1: (0) J2:(0) J3: (0) 
J4: (0) J5:(0) J6: (0) 
J7: (0) J8:(0) 


BE] 罗 


4-29 ”原点 设置 功能 界面 


莫 池 于 


4.8.5 设 定 / 初 始 化 


初始 化 

初始 化 指 对 程序 参数、 电池 使 用 时 间 的 初始 化 。 
(1) 程序 初始 化 一 一 删除 所 有 程序 。 

(2) 参数 初始 化 一 一 参数 回 到 出 厂 值 。 

(3) 电池 一 一 清除 电池 使 用 时 间 。 

操作 方法 参见 图 4-30。 


5.“ 设 定 /初始 化 ”界面 1“ 初 始 化 "界面 
《 设 定 / 初 始 化 > 初始 化 
1. 初始 化 2， 运 行 的 和 
3. 时 间 设 定 4. 版 本 Be 
L_ JP [_] 基 中 ] 
2“ 运 行 时 间 ” 界 面 
《运行 时 间 > 
运行 电源 ON 累计 时 间 45hr 
1 电池 剩余 时 间 “14447hr 
| J7: (0) J8:(0) 
CE] al 
3.* 时 间 设 定 ” 界 面 
时 
间 《时 间 设 定 > 
设 日 期 17-06-04 
定 
2 时 间 20:45:30 
口中 [可口 罗 | 
4 版 本 ”界面 
版 《版 本 > 
本 控制 器 : ver 
示 教 单元 ver 
LL blL | 


图 4-30 初始 化 功能 界面 


4.9 需要 思考 的 问题 


(1) 如 何 执行 调试 程序 的 单 步 运行 、 跳 转运 行 . 后 退 运行 ? 


(2) 如 何 进 行 初始 化 设置 ? 
(3) 如 何 进 行 原点 设置 ? 


圩 二 收 


第 4 日 一 一 使 用 示 载 单元 进行 编程 ,调试 及 设置 参 才 


第 5 章 第 5 日 一 机 器 人 系统 的 
输入 输出 信号 


【学 习 目 的 】 

在 一 条 实际 的 以 机 器 人 为 中 心 构成 的 生产 线 中 ,会 有 大 量 的 检测 信号 ,比如 “工件 运行 
到 位 “检测 完毕 “压力 不 足 ” 等 信号 ,这 些 信号 要 进入 到 机 器 人 控制 器 中 供 机 器 人 使 用 。 怎 
样 接 入 这 些 信号 在 2.7 节 中 已 经 做 了 说 明 ,本 章 的 学 习 内 容 是 如 何 定义 机 器 人 内 置 的 专用 
信号 ,如何 使 用 外 部 1/O 信号 。 


5.1 专用 1/0O 信号 


在 机 器 人 控制 器 中 ,为 了 方便 用 外 部 信号 对 机 器 人 进行 控制 ,预先 设计 配置 了 很 多 的 
“输入 输出 ”的 功能 。 例 如 ,输入 信号 有 ”自动 启动 交 停 止 , 输 出 信号 有 ”* 转 矩 到 达 关 发 生 碰 
撞 ? 等 。 在 机 器 人 使 用 前 ,需要 将 这 些 功 能 分 配 设 置 到 * 外 部 I/O 卡 ” 的 各 输入 输出 点 (通过 
参数 设置 ) ,如 图 5-1 所 示 。 


图 5-1 通过 参数 给 输入 输出 端子 分 配 功能 


在 未 进行 设置 前 ,“ 外 部 IO 卡 ” 的 各 输入 输出 点 是 没有 功能 的 (空白 的 )。 
由 于 外 部 输入 输出 信号 是 每 一 套 机 器 人 系统 都 必须 使 用 的 信号 ,是 每 一 套 机 器 人 系统 
的 基本 设置 ,本 章 将 详细 介绍 输入 输出 信号 的 功能 及 设置 。 


5.2 输入 输出 信号 的 分 类 


机 器 人 使 用 的 输入 输出 信号 分 类 如 下 。 
(1) 专用 输入 输出 信号 一 一 这 是 机 器 人 系统 内 置 的 输入 输出 功能 (信号 )。 这 类 信号 功 


能 已 经 由 系统 内 部 规定 但 是 具体 分 配 到 某 个 输入 输出 端子 还 需要 由 参数 设置 。 这 是 使 用 最 
多 的 信号 。 

(2) 通用 输入 输出 信号 一 一 这 类 信号 例如 “工件 到 位 ”定位 完成 ”由 设计 者 自行 定义 ， 
只 与 工程 要 求 相关 。 
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(3) 抓 手 信号 一 一 与 抓 手 相关 的 输入 输出 信号 。 


5.3 专用 输入 输出 信号 详解 


“1 


专用 输入 输出 信号 一 览 表 


在 机 器 人 系统 中 ,专用 输入 输出 ( 某 一 功能 ) 的 “名 称 (英文 )? 是 一 样 的 , 即 同一 “名 称 ( 英 
文 )” 可 能 表示 输入 也 可 能 表示 输出 ,初学 者 开始 阅读 指令 手册 时 会 感到 困惑 。 本 章 将 输入 


输出 信号 单独 列 出 ,便于 读者 阅读 和 使 用 。 
1. 专用 输入 信号 一 览 表 
表 5-1 是 专用 输入 信号 功能 一 览 表 ,这 一 部 分 信号 是 在 实际 工程 中 经 常 使 用 的 。 


表 5-1 专用 输入 信号 一 览 表 


序号 输入 信号 功能 简 述 英文 简称 ”| 出 厂 设 定 端子 号 
1 | 操作 权 使 外 部 信号 操作 权 有 效 /无 效 IOENA 5 
2 | 启动 程序 启动 START 3% 
3 | 停止 程序 停止 STOP 0 (固定 不 变 ) 

程序 停止 。 功 能 与 STOP 相同 。 但 
和 | 人 输入 端子 号 可 以 任意 设置 SO 
中 断 正 执 行 的 程序 , 回 到 程序 起 始 
5 | 程序 复位 行 。 对 应 多 任务 状态 ,使 全 部 任务 区 | SLOTINIT % 
程序 复位 
6 | 报警 复位 解除 报警 状态 ERRRESET | * 
机 器 人 伺服 电源 二 ON。 多 机 器 人 
| 移民 :ON 时 ,全 部 机 器 人 伺服 电源 二 ON Sen 
机 器 人 伺服 电源 二 OFF。 多 机 器 人 
| 本 时 ,全 部 机 器 人 伺服 电源 一 OFF SSDoe, 
使 自动 程序 生效 。 禁 止 在 非 自 动 模 
9 | 自动 模式 使 能 式 下 做 自动 运行 AUTOENA 
10 | 停止 循环 运行 停止 循环 运行 的 程序 CYCLE * 
11 | 机 械 锁 定 使 机 器 人 进入 机 械 锁 定 状态 MELOCK * 
12 | 回 待 避 点 回 到 预 设置 的 “ 待 避 点 ” SAFEPOS 六 
13 | 通用 输出 信号 复位 指令 全 部 “通用 输出 信号 复位 OUTRESET | * 
二 第 N 任务 区 内 程序 | 指令 “第 N 任务 区 内 程序 启动 ”, N= neiAR 
启动 1~32 
其 第 N 任务 区 内 程序 | 指令 “第 NN 任务 区 内 程序 停止 ”, N= ee > 
停止 1~32 
第 NN 台 机 器 人 伺服 | 指令 “第 N 台 机 器 人 伺服 电源 OFF”， 
二 | 二 浊 ER wi SnSRVOFF | * 
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续 表 
序号 输入 信号 功能 简 述 英文 简称 | 出 厂 设 定 端子 号 
17 | 第 NN 台 机 器 人 何 服 | 指令 "第 N 台 机 器 人 何 服 电源 ON™,， | VON |。 
电源 ON N=1~3 
8 | 第 N 台 机 器 人 机 械 | 指令 第 N 台 机 器 人 机 械 镇 定 "N= | AR ON | 。 
锁定 1~3 
19 | 选 定 程序 生效 未 信号 用 于 使 “ 选 定 的 程序 号 "生效 “| PRGSEL ’ 
“* 选 定 速度 比例 ”| 本 信和 号 用 于 使 * 选 定 的 速度 比例 ” 
20 生效 生效 OVRDSEL 类 
指定 在 选择 “程序 号 ”和 “速度 比例 ” 
21 | 数据 输入 等 数据 量 时 使 用 的 输入 信号 “起 始 | IODATA * 
号 "和 “结束 号 ” 
22 | 程序 号 输出 请 求 ”| 指令 输出 当前 执行 的 “程序 号 ” PRGOUT |* 
23 | 程序 行 号 输出 请 求 “| 指令 输出 当前 执行 的 “程序 行 号 ” | LINEOUT | * 
24 | 速度 比例 输出 请 求 “| 指令 输出 当前 “速度 比例 ” OVRDOUT | > 
25 | “报警 号 "输出 请 求 “| 指令 输出 当前 “报警 号 ” ERROUT | > 
使 JOG 功能 生效 (通过 外 部 端子 使 用 
26 | JOG 使 能 信号 JOG 功能 ) JOGENA 
| 设置 在 选择 "JOG 模式 ”时 使 用 的 端 
27 了 JOG 返 | 子 起 始 号 "和 “结束 号 ”。0/1/2/3/4 | JOGM 
一 关节 / 直 交 / 圆 简 /三 轴 直 交 /TOOL 
28 | JOG 十 指定 各 轴 的 JOG 十 信号 JOG 十 关 
29 | JOG= 指定 各 轴 的 JOG 一 信号 JOG— a 
_ 通过 数据 "起 始 位 "与 "结束 位 "设置 
30 | 工件 坐标 系 编号 “工件 坐标 系 编号 ” JOGWKND 关 
31 | JOG 报警 暂时 无 效 | 本 信和 号 二 ON, JOG 报警 暂时 无 效 。 | JOGNER 
是 否 允 许 外 部 信号 | 本 信号 二 ON/OFF, 允许 /不 允许 外 
32 | 控制 抓 手 部 信号 控制 抓 手 HANDENS | 2 
33 nll 设置 “控制 抓 手 的 输入 信号 范围 ” | HANDOUT | * 
第 NN 台 机 器 人 的 抓 | 。。 = 
34 | 手 报警 N1C3 | 魏 出 "第 NN 台 机 器 人 抓 手 报警 信号 ” | HNDERRn 
第 N 台 机 器 人 的 气 | 发 出 “第 N 台 机 器 人 的 气压 报警 ” 

35 压 报警 (N=1~5) 信号 AIRERRn 共 
6 | 第 N 台 宙 器 人 预 热 | 发 出 “第 N 台 机 器 人 预 热 运行 模式 有 | MaWUPENA | 。 
运行 模式 有 效 效 ” 信 号 (N=1~3) 

指定 需要 输出 位 置 | 指定 需要 输出 位 置 数据 的 “任务 
37 | 数据 的 “任务 区 ”号 | 区 ”号 PSSIOT 
指定 位 置 数据 类 型 
38 位 置 数 据 类 型 I/O= 关 节 型 变量 / 直 交 型 变量 PSTYPE 
指定 用 二 组 数据 表 » - 
39 | 示 “ 位 置 至 量 号 ” | 指定 用 一 组 数据 表示 “位 置 变量 号 ” | PSNUM 
40 | 输出 位 置 数据 指令 ”| 指令 输出 当前 “位 置 数据 ” PSOUT x 
41 | 输出 控制 柜 温 度 ”| 指令 输出 控制 柜 实 际 温度 TMPOUT |* 


* 表示 可 以 由 用 户 自行 设置 输入 端子 号 。 


2. 专用 输出 信号 一 览 表 
在 机 器 人 系统 中 ,对 于 同一 功能 .输入 输出 信号 的 “英文 简称 ”是 相同 的 。 但 是 输入 信号 
的 功能 是 使 得 这 一 功能 起 作用 ,输出 信号 的 功能 是 表示 这 一 功能 已 经 起 作用 。 专 用 输出 信 


号 大 多 是 表示 机 器 人 系统 的 工作 状态 。 表 5-2 所 示 是 专用 输出 信号 一 览 表 。 


表 5-2 专用 输出 信号 一 览 表 


序号 输出 信号 功 能 英文 简称 出 厂 设置 
1 _| 控制 器 电源 ON 表示 控制 器 电源 ON, 可 以 正常 工作 “| RCREADY % 
表示 操作 面板 选择 自动 模式 ,外 部 IO 
2 | 远程 模式 信号 操作 有 效 ATEXTMD 关 
3 | 示 教 模式 表示 当前 工作 模式 为 “ 示 教 模式 ” TEACHMD % 
4 | 自动 模式 表示 当前 工作 模式 为 “自动 模式 ” ATTOPMD 关 
5 | 外 部 信号 操作 权 有 效 表示 “外 部 信号 操作 权 有 效 ” IOENA 3 
6 | 程序 已 启动 表示 机 器 人 进入 “程序 已 启动 ”状态 | START 关 
7 “| 程序 停止 表示 机 器 人 进入 “程序 暂停 ”状态 STOP * 
8 | 程序 停止 表示 当前 为 “程序 暂停 ”状态 STOP2 关 
9 | STOP 信号 输入 表示 正在 输入 STOP 信号 STOPSTS 类 
10 | 任务 区 中 的 程序 可 选择 状态 | 表示 “任务 区 处 于 程序 可 选择 状态 ” | SLOTINIT % 
11 | 报警 发 生 中 表示 系统 处 于 “报警 发 生 ” 状 态 ERRRESET 类 
12 | 伺服 ON 表示 系统 当前 处 于 “伺服 ON” 状 态 SRVON 1 
13 | 伺服 OFF 表示 系统 当前 处 于 “伺服 OFF” 状 态 | SRVOFF 伯 
14 | 可 自动 运行 表示 系统 当前 处 于 “可 自动 运行 ”状态 | AUTOENA x 
15 | 循环 停止 信号 表示 “循环 停止 信号 ” 正 输入 中 CYCLE % 
16 | 机 械 锁 定 状态 表示 机 器 人 处 于 “机 械 锁 定 状态 ” MELOCK * 
17 | 回归 待 避 点 状态 表示 机 器 人 处 于 “回归 待 避 点 状态 ” SAFEPOS * 
18 | 电池 电压 过 低 表示 机 器 人 “电池 电压 过 低 ” BATERR * 
19 | 严重 级 报警 表示 机 器 人 出 现 * 严 重 级 故障 报警 ” HLVLERR x 
20 | 轻 量 级 故障 报警 表示 机 器 人 出 现 * 轻 量 级 故障 报警 ” LLVLERR % 
21 | 警告 型 故障 表示 机 器 人 出 现 “ 警 告 型 故障 ” CLVLERR * 
22 | 机 器 人 急 停 表示 机 器 人 处 于 “ 急 停 状态 ” EMGERR 关 
23 | 第 NN 任务 区 程序 在 运行 中 | 表示 “第 N 任务 区 程序 在 运行 中 ” SnSTART x 
24 | 第 N 任务 区 程序 在 暂停 中 “| 表示 “第 N 任务 区 程序 在 暂停 中 SnSTOP 关 
25 | 第 N 台 机 器 人 伺服 OFF 表示 “第 N 台 机 器 人 伺服 OFF” SnSRVOFF 关 
26 | 第 N 台 机 器 人 伺服 ON 表示 “第 N 台 机 器 人 伺服 ON” SnSRVON 类 
元 4“ 会 
27 | 第 N 台 机 器 人 机 械 锁 定 a SnMELOCK | * 
对 数据 输出 ,指定 输出 信号 的 “起 始 
28 | 数据 输出 区 域 位 ”和 “结束 位 ” IODATA x 
29 |“ 程 序号 ”数据 输出 中 表示 当前 正在 输出 “程序 号 ” PRGOUT * 
30 _ |“ 程序 行 号 ”数据 输出 中 表示 当前 正在 输出 “程序 行 号 ” LINEOUT * 
31 |“ 速 度 比 例 ” 数 据 输出 中 表示 当前 正在 输出 “速度 比例 ” OVRDOUT x 
32 |“ 报 警号 ”输出 中 表示 当前 正在 输出 “报警 号 ” ERROUT * 
33 | JOG 有 效 状态 表示 当前 处 于 “JOG 有 效 状 态 ” JOGENA * 
34 | JOG 模式 表示 当前 的 “JOG 模式 ” JOGM x 
35 | 当前 工件 坐标 系 编号 显示 “当前 工件 坐标 系 编号 ” JOGWKND x* 
36 | 抓 手工 作 状 态 输出 抓 手 工作 状态 (输出 信号 部 分 ) HNDCNTLn * 
37 | 抓 手工 作 状态 输出 抓 手 工作 状态 (输入 信号 部 分 ) HNDSTSn 关 
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续 表 
序号 输出 信号 功 能 英文 简称 出 厂 设 置 
外 部 信号 对 抓 手 控制 的 有 | 表示 “外 部 信号 对 抓 手 控制 的 有 效 /无 
38 效 /无 效 状 态 效 状态 ” HANDENA % 
39 | 第 N 台 机 器 人 抓 手 报警 表示 “第 N 台 机 器 人 抓 手 报警 ” HNDERRn x 
40 | 第 N 台 机 器 人 气压 报警 表示 “第 N 台 机 器 人 气压 报警 ” AIRERRn x 
S 用 输出 端子 “起 始 位 ”结束 位 ”表示 
41 | 用 户 定义 区 编号 “用 户 定义 区 编号 ” USRAREA 
42 | 易 损 件 维修 时 间 表示 易 损 件 到 达 “ 维 修 时 间 ” MnPTEXC x 
43 | 机 器 人 处 于 “ 预 热 工作 模式 ”| 表示 “机 器 人 处 于 预 热 工作 模式 ” MnWUPENA * 
用 输出 端子 “起 始 位 ”结束 位 表示 
44 | 输出 位 置 数据 的 任务 区 编号 “输出 位 置 数据 的 任务 区 编号 * PSSLOT x 
表示 输出 的 “位 置 数据 类 型 "是 关节 型 
45 | 输出 的 “位 置 数据 类 型 还 是 直 交 再 PSTYPE 
本 用 输出 端子 “起 始 位 ”结束 位 ”表示 
46 | 输出 的 “位 置 数据 编号 “输出 位 置 数据 的 编号 ” PSNUM 
47 | “位 置 数据 "的 输出 状态 ee 位置 数 所 的 物 出 | Om 
48 | 控制 柜 温度 输出 状态 表示 当前 处 于 “控制 柜 温度 输出 状态 ”| TMPOUT x 


* 表示 可 以 由 用 户 自行 设置 输出 端子 号 。 


5.3.2 专用 输入 信号 详解 


本 节 解 释 “ 专 用 输入 信号 ”以 及 这 些 信号 对 应 的 参数 。 出 厂 值 是 指出 厂 时 预 分 配 的 输入 
端子 编号 。 机 器 人 系统 本 身 已 经 内 置 了 专用 的 “功能 ”, 本 节 将 对 这 些 功能 进行 解释 。 使 用 
时 通过 参数 将 这 些 功能 赋予 指定 的 “输入 端子 ”, 有 些 功能 特别 重要 ,所 以 出 厂 时 已 经 预先 设 
定 了 “输入 端子 编号 ”, 即 该 输入 端 被 指定 了 功能 ,不 得 更 改 (例如 STOP 功能 )。 如 果 出 厂 
值 =“ 一 1” 则 表示 可 以 任意 设置 “输入 端子 编号 ”。 设 置 参数 是 通过 软件 RT ToolBox 或 示 
教 单 元 进行 的 ,所 以 本 节 使 用 了 软件 RT ToolBox 的 参数 设置 界面 ,这 样 更 有 助 于 读者 对 
“专用 功能 ”的 理解 ,如 表 5-3 所 示 。 


表 5-3 输入 信号 
序号 名 称 功 能 对 应 参数 出 厂 值 (端子 号 ) 
1 | 操作 权 使 外 部 信号 操作 权 有 效 /无 效 IOENA 5 
| 2 | 


参数 名 : IOENA。 机 要 号 : 0 


说 明 : Operation enable INPUT Operation enable OUTPUT | 


1: 5 
图 中 ,设置 对 应 本 功能 的 输入 端子 号 ==5, 输 入 端子 5 一 ON/OFF, 对 应 “外 部 信和 号 操作 权 ” 有 效 / 无 效 。 输 
人 端子 5 一 ON, 从 1/O 卡 输入 的 信号 生效 。 输 入 端子 5 二 OFF, 从 1/O 卡 输入 的 信号 无 效 


续 表 
对 应 参数 出 厂 值 (端子 号 ) 


2 | 启动 程序 启动 


START 3 


参数 名 : START ”机 器 号 : 0 


说 明 : All slot Start INPUT ,During rxrcute OUTPUT | 
3: 3 
3 四 


ETT 本 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 3, 如 输入 端子 3 二 ON, 则 所 有 任务 区 内 程序 启动 


3 | 停止 程序 停止 


STOP 0( 固 定 不 变 ) 


参数 名 : STOP 机 器 号 : 0 


说 明 : All slot Stop INPUT(no change), During wait ouTPuT| 


套数 的 编辑 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =0, 如 输入 端子 0 二 ON, 则 所 有 任务 区 内 “程序 停止 "。STOP 功能 


对 应 的 输入 端子 号 固定 设置 =0 


| i 入 端子 号 可 以 任意 设置 


程序 停止 。 功 能 与 STOP 相同 。 但 输 


STOP2 


参数 的 编辑 


参数 名 : STOP2 ”机 器 号 :0 


说 明 : All slot Stop INPUT ,During wait OUTPUT 


1: 
2: 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 ==8, 如 输入 端子 8 二 ON, 则 所 有 任务 区 内 “程序 停止 "。STOP2 功 


能 对 应 的 输入 端子 号 可 以 由 用 户 设置 
中 断 正在 执行 的 程序 , 回 到 种 序 起 娩 
行 。 对 应 多 任务 状态 ,使 全 部 任务 区 程 
is 序 复位 。 当 对 应 启动 条 件 为 ALWAYS | SLOTINIT 
和 ERROR 时 , 则 不 能 够 执行 复位 
参数 的 编辑 


参数 名 : SLOTINIT ”机 器 号 : 0 


说 明 : Program reset INPUT ,Program select enable OUTPUT | 


1s 6 
-二 -1 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =6, 如 输入 端子 6 一 ON, 则 所 有 任务 区 内 “程序 复位 ” 
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续 表 
序 写 名 称 功 能 对 应 参数 | 出厂 值 (靖子 号 ) 
6 | 报警 复位 解除 报警 状态 ERRRESET 2 

套数 的 编辑 
参数 名 : ERRRESET ”机 器 号 : 0 
ER ] 
1: 2 
2 加 
图 中 ,设置 对 应 本 功能 的 输入 端子 号 一 2, 如 输入 端子 2 二 ON, 则 解除 报警 状态 
机 器 人 伺服 电源 二 ON 
7 | 伺服 ON 多 机 器 人 时 ,全 部 机 器 人 伺服 电源 | SRVON 4 


一 ON 


| 参数 名 : SRVON ”机 可 号 ， 0 


说 明 : Servo on INPUT,Duringservo on OUTPUT | 


1: 4 
图 中 ,设置 对 应 本 功能 的 输入 端子 号 ==4, 如 输入 端子 4 二 ON, 则 机 器 人 伺服 电源 二 ON 


机 器 人 伺服 电源 一 OFF 
8 | 伺服 OFF 多 机 器 人 时 ,全 部 机 器 人 伺服 电源 | SRVOFF 
一 OFF 


参数 名 ， SRVOFF 机 器 号 : 0 


说 明 : Servo off INPUT ,servo on disable OUTPUT | 


1: 
2: 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 ==9, 如 输入 端子 9 二 ON, 则 机 器 人 伺服 电源 二 OFF 


到 使 自动 程序 生效 。 禁 止 在 非 自 动 模式 
9 | 自动 模式 使 能 下 做 自动 运行 AUTOENA 
| S| 


参数 名 : AUTOENA ”机 器 号 : 0 


说 明 : AUTO enable INPUT AUTO enable OUTPUT 


站 10 
FE 


-1 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 10, 如 输入 端子 10 二 ON, 则 机 器 人 进入 自动 使 能 模式 


序号 


名 称 


功 能 


对 应 参数 


续 表 
出 厂 值 (端子 号 ) 


10 


停止 循环 运行 


停止 循环 运行 的 程序 


CYCLE 


参数 的 编辑 


参数 名 : CYCLE 机 器 号 : 0 


说 明 : Cycle stop INPUT,Cyde stop OUTPUT ] 


1: 11 
2: 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 = 二 11, 如 输入 端子 11 二 ON, 则 停止 循环 运行 的 程序 


使 机 器 人 进入 机 械 锁 定 状态 。 


11 | 机 械 锁 定 机 械 锁定 状态 一 程序 运行 ,机 械 不 动 


MELOCK 


套数 的 编辑 


参数 名 : MELOCK 机 器 号 :0 


说 明 : Machine lock INPUT ,Machine lock OUTPUT | 


1: 
2: 


12 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 12, 如 输入 端子 12 二 ON, 则 机 械 锁 定 功 能 生效 


12 


回 待 避 点 


回 到 预 设置 的 “ 待 避 点 ” 


SAFEPOS 


参数 名 :Safepos 机 器 号 :0 


说 明 : Move home INPUT ,Moving home OUTPUT | 


1: 
2: 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 ==13, 如 输入 端子 13 二 ON, 则 执行 回 待 避 点 动作 


13 | 通用 输出 信号 复位 


指令 全 部 “通用 输出 信号 复位 ” 


OUTRESET 


| 和 参数 的 编辑 |] 
1 


参数 名 : OUTRESET 机 器 号 : 0 


说 明 : General output reset INPUT ,No signal 


1: 14 
FE 


= 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =14, 如 输入 端子 14 二 ON, 则 执行 “通用 输出 信号 复位 ?动作 


第 
5 
章 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 烧 工 业 夫 器 人 


续 表 
序号 名 称 功 能 对 应 参数 。 “| 出 厂 值 (端子 号 ) 
14 | 第 NN 任务 区 内 程 | 指令 "第 N 任务 区 内 秩序 启动 "NI | seTART 

序 启动 ~32 
ET 


参数 名 : S2START 机 器 号 : 0 


说 明 : Slot2 Start INPUT ,Slot2 During execute OUTPUT | 


1; 15 
> 二 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 15, 如 输入 端子 15 二 ON, 则 执行 “第 2 任务 区 内 程序 启动 ” 


15 


第 NN 任务 区 内 程 
序 停止 


指令 “第 N 任务 区 内 程序 停止 ”, N==1 
~32 


SnSTOP 


Es 


参数 名 : S2STOP 机 器 号 : 0 


| 


说 明 : Slot2 Stop INPUT, slot2 During wait OUTPUT 


1: 16 
2: | 


本 功能 的 输入 端子 号 二 16, 如 输入 端子 16 王 ON, 则 执行 “第 2 任务 区 内 程序 停止 ” 


图 中 ,设置 对 应 
第 N 台 机 器 人 伺 | 指令 “第 N 台 机 器 人 伺服 电源 OFF”,N 

29 | 服 电源 OFF -1~3 SSO 
第 NN 台 机 器 人 伺 | 指令 “第 NN 台 机 器 人 伺服 电源 ON”,N 

27 | 服 电源 ON —1~3 Spe 

18 第 NN 台 机 器 人 机 | 指令 “第 N 台 机 器 人 机 械 锁定 ”,N=1 ee 
械 锁 定 ld 

19 | 选 定 程序 生效 本 信号 用 于 使 “ 选 定 的 程序 号 ?生效 PRGSEL 

和 参数 的 编辑 


参数 名 : PRGSEL 


机 要 号 : 0 


说 明 : Program number srlect INPUT,No signal 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 18, 如 输入 端子 18 二 ON, 则 “ 选 定 的 程序 号 ”生效 


续 表 


序号 名 称 功 能 对 应 参数 出 厂 值 ( 端 子 号 ) 
20 了 和 本 信号 用 于 使 * 选 定 的 速度 比例 ”生效 OVRDSEL 
| 


参数 名 : OVRESBL 机 器 号 : 0 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 一 19, 如 输入 端子 19 二 ON, 则 “ 选 定 速度 比例 ”生效 
指定 在 选择 “程序 号 ”和 “速度 比例 ”等 
21 | 数据 输入 数据 量 时 使 用 的 输入 信号 “起 始 号 ”和 | IODATA 
“结束 号 ” 
参数 的 编辑 


参数 名 ，IODATA ”机 器 号 ， 0 | 


说 明 : Value input signal (start,.end)INPUT ,Value output signal (startend)OUTPUT | 


SN 
te 


[7 
bg 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 王 12 一 15 ,输入 端子 号 二 12 一 15 组 成 的 (二 进 制 ) 数 据 可 以 为 “程序 
号 所 速 度 比例 ”等 数据 输入 量 


22 | 程序 号 输出 请 求 指令 输出 当前 执行 的 “程序 号 ” PRGOUT 


会 数 的 编辑 


参数 名 : PRGOUT ”机 器 号 : 0 


说 明 : prog No. output requirerement INPUT ,During output prg.No. OUTPUT 


1s 
2: 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 一 20, 如 输入 端子 20 二 ON, 则 指令 输出 当前 执行 的 “程序 号 ” 


23 | 程序 行 号 输出 请 求 | 指令 输出 当前 执行 的 “程序 行 号 ” LINEOUT 


ET 


人 参数 名 : LINEOUT ”机 要 号 : 0 


说 明 : line No. output requirerement INPUT ,During output line No. OUTPUT | 


iE 21 


-1 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 21, 如 输入 端子 21 一 ON, 则 指令 输出 当前 执行 的 “程序 行 号 ” 


击 吕 恰 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 嵌 工 业 帮 器 人 


续 表 
序号 名 称 功 能 对 应 参数 。 “| 出 厂 值 (端子 号 ) 
24 | 速度 比例 输出 请 求 | 指令 输出 当前 “速度 比例 ” OVRDOUT 
套数 的 篇 多 


大 数 名 : OVRDOUT 机 器 号 : | 


说 明 : OVRD output requirerement INPUT ,During output OVRD OUTPUT | 


i 22 


2: < 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 22, 如 输入 端子 22 二 ON, 则 指令 输出 当前 执行 的 “速度 比例 ” 


25 | “报警 号 ?输出 请 求 | 指令 输出 当前 “报警 号 ” ERROUT 
[一 samaw ] 


夫 数 名 :ERROUT “机 器 号 : 0 | 


说 明 : Err No output requirerement INPUT ,During output Err. NO. OUTPUT | 


23 
E i 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 23, 如 输入 端子 23 一 ON, 则 指令 输出 当前 的 * 报 警号" 


26 | JOG 使 能 信号 使 JOG 功能 生效 (通过 外 部 端子 使 用 JOGENA 


JOG 功能 ) 
| 多数 的 编辑 | E 到 


大 数 名 ， JOGENA。 机 器 号 : 0 | 


说 明 : JOG command INPUT,During JOG OUTPUT ] 


24 
有 二 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 24, 如 输入 端子 24 二 ON, 则 JOG 功能 生效 (通过 外 部 端子 使 用 
JOG 功能 ) 


设置 在 选择 “JOG 模式 ”时 使 用 的 端子 
a 用 数据 设置 JOG |“ 起 始 号 ”和 “结束 号 ” JOGM 
运行 模式 0/1/2/3/4 二 关节 / 直 交 / 圆 简 / 三 轴 直 
交 /TOOL 
7 


参数 名 : JOGM ”机 村 号 : 0 | 


说 明 : JOG mode specification (sartend)INPUT， 
JOG mode output (startend)OUTPUT 

1: 25 

2: 29 

3 -1 

4 -1 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 一 25 一 29 ,输入 端子 号 一 25 一 29 组 成 的 数据 为 “JOG 运行 的 工作 模 
式 ”。0/1/2/3/4 一 关节 / 直 交 / 圆 简 / 三 轴 直 交 /TOOL。 例 如 : 
输入 端子 号 一 25 一 29 组 成 的 数据 一 1, 则 选择 直 交 模式 


续 表 


序号 名 称 功 能 对 应 参数 出 厂 值 ( 端 子 号 ) 
28 | JOG 十 指定 各 轴 的 JOG 十 信号 JOG 十 
[一 saw |] 


套数 名 : JOG+ ”机 器 号 : 0 


说 明 : JOG + specification (start end) INPUT ,No signal 


Ls 30 
35 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =30 一 35, 即 输入 端子 30 二 及 轴 JOG 十 ,输入 端子 31==J2 轴 
JOG 十 ,…… 输 入 端子 35 二 J6 轴 JOG 十 


29 | JOG 一 指定 各 轴 的 JOG 一 信号 JOG 一 


| 多数 的 多加 | 


套数 名 : JOG 机 器 号 : 0 | 


说 明 : JOG - specification (start, end) INPUT,No signal | 


36 
40 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =36 一 40, 即 输入 端子 36=]1 轴 JOG 一 ,输入 端子 37=J2 轴 JOG 一 ， 
ee 输入 端子 40=J6 轴 JOG 一 


本 通过 数据 “起 始 位 ”与 “结束 位 ”设置 “ 工 
30 | 工件 坐标 系 编号 件 坐 标 系 编号 ” JOGWKND 
| 报警 暂 时 | 二 信号 一 ON, JOG 报警 暂时 无 效 JOGNER 
| 会 妆 的 编辑 | 


大 数 名 : JOGNER ”机 器 号 :0 | 


说 明 : Emor disregard at JOG INPUT ,Durind Error disregard at JOG OUTPUT | 


1: 41 
2: -a 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 一 41, 如 输入 端子 41 一 ON, 则 JOG 报警 暂时 无 效 


是 否 允许 外 部 信号 | 本 信号 = ON/OFF, 允许 /不 允许 外 部 
32 | 控制 抓 手 信号 控制 抓 手 人 


| 


参数 名 : HANDENA 机 器 号 : 0 


说 明 : Hand control enable INPUT ,Hand control enable OUTPUT 


Ib 41 
和 i 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 42, 如 输入 端子 42 二 ON, 则 允许 外 部 信号 控制 抓 手 。 如 输入 端子 


42 二 OFF, 则 不 允许 外 部 信号 控制 抓 手 上 
章 


第 5 日 一 一 机 器 人 夭 统 的 输入 输出 信号 


30 日 学 嵌 工 业 胡 器 人 


续 表 
序号 名 称 功 能 对 应 参数 。 “| 出 厂 值 (端子 号 ) 
33 | 近 制 抓 手 的 输入 信 | 设置 “控制 抓 手 的 输入 信号 范围 " HANDOUT 

号 范围 
ET 一 


参数 名 : HANDOUT 机 器 号 : 0 


说 明 : Hand output control sgnal INPUT(Start,end) | 


Es 43 
2: 49 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =43 一 49, 即 输入 端子 43 一 49 为 “控制 抓 手 的 输入 信号 范围 ” 


第 NN 台 机 器 人 的 

34 | 抓 手 报警 发 出 "第 NN 台 机 器 人 抓 手 报警 信号 ” | HNDERRn 
ik 

套数 的 编辑 


参数 名 : HANDERR1 机 器 号 ， 0 


说 明 : Robort1 hand error requirement During robort1 hang errr OUTPUT | 


1: 
2: 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 ==50, 如 输入 端子 50 二 ON, 则 发 出 “第 N 台 机 器 人 抓 手 报警 信号 ” 


第 N 台 机 器 人 的 

35 | 气压 报警 发 出 “第 NN 台 机 器 人 的 气压 报警 "信号 | AIRERRn 
(N=1~5) 

第 NN 台 机 器 人 预 | 发 出 “第 NN 台 机 器 人 预 热 运行 模式 有 | MnWUPENA 
热 运行 模式 有 效 效 ” 信 号 (N=1~3) 


区 中 


参数 名 : M1WUPENA 机 器 号 : 0 


说 明 : Robort1 warm up mode setting INPUT,Robort1 warm up mode enable 
OUTPUT 


1: 51 
2: 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 51, 如 输入 端子 51 二 ON, 则 发 出 “第 N 台 机 器 人 预 热 运行 模式 有 


效 ” 


信号 


续 表 


序 | 名称 | 功 能 | 对 应 参数 [出厂 值 ( 喘 子 号 ) 
指定 需要 输出 位 置 有 
37 数据 的 “任务 区 ”号 指定 需要 输出 位 置 数据 的 “任务 区 ”号 | PSSLOT 
| 


参数 名 : PSSLOT 机 器 号 :0 | 


说 明 : Slot number (start,end)INPUT ,Slot num ber (start,end) OUTPUT 


10 
3 14 
3 20 
4 24 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 10~~14, 即 输入 端子 10 一 14 构成 的 数据 为 “需要 输出 位 置 数据 的 
“任务 区 ?号 ” 


指定 位 置 数据 美 型 
38 位置 数据 类 型 。 | 1/0 一 关节 型 变量 / 直 交 理 变 量 


| 参数 的 编辑 
参数 名 ,PSTYPE 机 号 :0 | 


说 明 : Data type number INPUT,Data type number OUTPUT ] 
1: 53 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =53, 输 入 端子 53 王 1/0, 对 应 “关节 型 变量 / 直 交 型 变量 ” 


指定 用 一 组 数据 表 a 
39 示 “ 位 置 变量 号 ” 指定 用 一 组 数据 表示 “位 置 变 量 号 PSNUM 
参数 的 编辑 


和 参数 名 ，PSNUM 机 器 号 ，0 | 


说 明 : Position number (start,end)INPUT ,Position number (start.end) OUTPUT 


30 
34 
40 
44 


i 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 =30 一 34, 即 输入 端子 30 一 34 构成 的 数据 表示 “位 置 变量 号 ” 


40 | 输出 位 置 数据 指令 | 指令 输出 当前 “位 置 数据 ” PSOUT 
[一 aa] E33 


套数 名 : PSOUT 机 器 号 : 0 


说 明 : Position data requirementINPUT ,During output position OUTPUT | 


Wi 54 
2: 


= 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 一 54, 如 输入 端子 54 二 ON, 则 指令 输出 当前 “位 置 数据 ” 


击 吕 恰 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 典 工 业 胡 器 人 


续 表 
序号 名 称 功 能 对 应 参数 出 厂 值 ( 端 子 号 ) 
41 | 输出 控制 柜 温度 指令 输出 控制 柜 实际 温度 TMPOUT 
E> TI EE 


参数 名 : TMPOUT 机 器 号 : 0 


说 明 : Temperature in RC output requirement INPUT , 
During output Temperature in RC OUTPUT 

FE 55 
a eT” 


图 中 ,设置 对 应 本 功能 的 输入 端子 号 二 55, 如 输入 端子 55 二 ON, 则 指令 输出 控制 柜 温度 


5.3.3 专用 输出 信号 详解 


本 节 解 释 专用 输出 信号 以 及 这 些 信号 对 应 的 参数 ,如 表 5-4 所 示 。 出 厂 值 是 指出 厂 时 
预 分 配 的 输出 端子 序号 。 由 于 同一 参数 包含 输入 信号 与 输出 信和 号 的 内 容 , 因 此 必须 理解 : 
参数 只 是 表示 某 一 功能 ,输入 信号 是 驱动 这 一 功能 生效 ,输出 信号 是 表示 这 一 功能 已 经 
生效 。 

表 5-4 专用 输出 信号 


序号 名 称 功 能 对 应 参数 出 厂 值 (端子 号 ) 
1 | 控制 器 电源 ON 表示 控制 器 电源 ON, 可 以 正常 工作 RCREADY 


EE TT | 


参数 名 : RCREADY ”机 器 号 :0 


说 明 : No signal ,RIC ready OUTPUT 


1: -1 
2: 2 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 ==2, 如 果 控 制 器 电源 ON, 则 输出 端子 2=ON 


= 表示 操作 面板 选择 自动 模式 ,外 部 MO 
2 | 远程 模式 信号 操作 有 效 ATEXTMD 


| 2 | | 


会 数 名 : ATEXTMD 机 器 号 : 0 


说 明 : No signal ,Auto (Ext mode OUTPUT 


LE -1 
> 4 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 ==4, 如 果 本 功能 生效 , 则 输出 端子 4 二 ON 


续 表 


序号 名 称 功 能 对 应 参数 出 厂 值 (端子 号 ) 
3 | 示 教 模式 表示 当前 工作 模式 为 “ 示 教 模式 ” TEACHMD 


参数 名 : TEACHMD ”机 器 号 : 0 


说 明 : No sgnal ,Teach mode OUTPUT | 


| 
Ls -1 
2: 


5 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 一 5, 如 果 当 前 工作 模式 为 “ 示 教 模式 ”, 则 输出 端子 5 一 ON 


4 | 自动 模式 表示 当前 工作 模式 为 “自动 模式 ” ATTOPMD 
大 妆 的 编辑 


参数 名 : ATTOPMD ”机 器 号 : 0 


说 明 : No signal ,AUTO(OP) mode OUTPUT ] 


aa | 


6 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 一 6, 如 果 当 前 工作 模式 为 “自动 模式 ”, 则 输出 端子 6 二 ON 


外 部 信号 操作 权 | 表示 “外 部 信号 操作 权 有 效 ”"。 当 输出 
有 效 3 三 ON, 表示 外 部 操作 权 有 效 


参数 的 编辑 


参数 名 : IOENA ”机 器 号 ， 0 


IOENA 3 


说 明 : Operation enable INPUT ,Operation enable OUTPUT 


{EE 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 3, 如 果 外 部 操作 权 已 经 有 效 , 则 输出 端子 3 一 ON 


6 | 程序 已 启动 表示 机 器 人 进入 “程序 已 启动 ”状态 START 


套数 的 编辑 


参数 名 : START “机 器 号 : 0 


说 明 : All slot Start INPUT During execute OUTPUT 


3 
Bs 6 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 = 二 6, 如 果 机 器 人 进入 “程序 已 启动 ”状态 , 则 输出 端子 6 二 ON 


震 吕 恰 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 烧 工 业 机 器 人 


续 表 
序号 名 称 功 能 对 应 参数 出 厂 值 (端子 号 ) 
7 | 程序 停止 表示 机 器 人 进入 “程序 暂停 ”状态 STOP 
E77 
参数 名 : STOP ”机 器 号 : 0 


说 明 : All slot Stop INPUTIno change) ,During wait OUTPUT | 


1: 
让 党 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 ==7, 如 果 机 器 人 进入 “程序 暂停 ”状态 , 则 输出 端子 7 二 ON 


8 | 程序 停止 表示 “程序 暂停 ”状态 STOP2 
套数 的 儿 因 
| 参数 名 ，STOP2 机 器 号 :0 


说 明 : All slot Stop INPUT,During wait OUTPUT | 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 8, 如 果 机 器 人 进入 “程序 暂停 2" 状 态 , 则 输出 端子 8 二 ON 


9 | STOP 信号 输入 


表示 正在 输入 STOP 信号 


STOPSTS 


参数 的 编辑 


参数 名 : STOPSTS ”机 器 号 ， 0 


说 明 : No signal 


,Stop in OUTPUT 


1: 
2: 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =30, 如 果 正 在 输入 STOP 信号 , 则 输出 端子 30 二 ON 


任务 区 中 的 程序 可 |， 。 
10 选择 状态 表示 “任务 区 处 于 程序 可 选择 状态 SLOTINIT 
参数 的 编辑 


套数 名 : SLOTINIT ”机 器 号 : 0 


说 明 : Program resetINPUT ,program select enable OUTPUT 


i -1 


FE 9 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 9, 如 果 “ 任 务 区 处 于 程序 可 选择 状态 ”, 则 输出 端子 9 二 ON 


续 表 


序号 名 称 功 能 对 应 参数 出 厂 值 (端子 号 ) 
11 | 报警 发 生 中 表示 系统 处 于 “报警 发 生 中 ” ERRRESET 
E77 


参数 名 : ERRRESET ”机 器 号 : 0 


说 明 : Error resetINPUT,During error OUTPUT | 


1: 2 
下 四 


图 中 设置 的 输出 端子 号 二 2, 如 系统 处 于 “报警 发 生 中 ”, 则 输出 端子 2 二 ON 


12 | 伺服 ON 表示 当前 处 于 “伺服 ON” 状 态 SRVON 1 
[sa 一 


| 参数 名 : SRVON 机 器 号 :0 


说 明 : Servo on INPUT ,During servo on OUTPUT | 


图 中 设置 的 输出 端子 号 二 1, 如 果 当 前 为 “伺服 ON” 状 态 , 则 输出 端子 1=ON 


13 | 伺服 OFF 


表示 当前 处 于 “伺服 OFF” 状 态 


SRVOFF 


参数 的 编辑 


参数 名 : SRVOFF ”机 器 号 : 0 


说 明 : Servo off INPUT, servo on disable OUTPUT 


1: 
2: 


图 中 设置 的 输出 端子 号 = 二 10, 如 果 当 前 处 于 “伺服 OFF” 状 态 , 则 输出 端子 10 二 ON 


14 | 可 自动 运行 


表示 当前 处 于 “可 自动 运行 ”状态 


AUTOENA 


套数 的 编辑 


参数 名 : AUTOENA ”机 器 号 : 0 


说 明 : AUTO enable INPUT, AUTO enable OUTPUT 


1 -1 
3 11 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 ==11, 如 果 当 前 处 于 “可 自动 运行 ”状态 , 则 输出 端子 11 二 ON 


击 吕 收 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 嵌 工 业 胡 器 人 


序号 名 称 功 能 


续 表 
出 厂 值 (端子 号 ) 


表示 “循环 停止 信和 号” 


15 | 循环 停止 信号 正 输入 中 


ETT 


参数 名 : CYCLE 机 器 号 : 0 


说 明 : Cycle stop INPUT, During Cycle stop OUTPUT | 


i -1 
2: 12 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 = 二 12, 如 果 “ 循 环 停止 信号 ” 正 输 入 中 , 则 输出 端子 12 一 ON 


表示 机 器 人 处 于 “机 械 锁 定 状态 ”。“ 机 
16 | 机 械 锁定 状态 械 锁定 状态 ”是 程序 运行 ,机 器 人 不 | MELOCK 
动作 
参数 的 编辑 


参数 名 : MELOCK ”机 器 号 : 0 


1: 
2: 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =13, 如 果 机 器 人 处 于 “机 械 锁 定 状态 ” 则 输出 端子 13 王 ON 


17 | 回归 待 避 点 状态 ”| 表示 机 器 人 处 于 “回归 待 避 点 状态 ” 


SAFEPOS 


参数 的 编辑 


参数 名 : SAFEPOS 机 器 号 : 0 


说 明 : Move home INPUT ,Moving home OUTPUT 


有 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =14, 如 果 机 器 人 处 于 “回归 待 避 点 状态 ”, 则 输出 端子 14 一 ON 


18 | 电池 电压 过 低 表示 机 器 人 “电池 电压 过 低 ” 


BATERR 


aes] 


参数 名 : BATERR ”机 要 号 : 0 


说 明 : No signal ,low battery OUTPUT 


Bs 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 ==16, 如 果 机 器 人 处 于 “电池 电压 过 低 状 态 ”, 则 输出 端子 16 一 ON 


序号 名 称 


功 能 


对 应 参数 


续 表 
出 厂 值 (端子 号 ) 


19 | 严重 级 报警 


表示 机 器 人 出 现 “ 严 重 级 故障 报警 ” 


HLVLERR 


套 效 的 编辑 


参数 名 : HLVLERR ”机 器 号 : 0 


说 明 : No signal ,During HERROR OUTPUT | 


-1 
2: 17 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 17, 如 果 机 器 人 处 于 “严重 级 故障 报警 ”, 则 输出 端子 17 一 ON 


20 | 轻微 级 故障 报警 


表示 机 器 人 出 现 “ 轻 微 级 故障 报警 ” 


LLVLERR 


套数 的 编辑 


参数 名 : LLVLERR ”机 器 号 : 0 


说 明 : No signal ,During LERROR OUTPUT | 


1: | 
2: 19 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 ==19, 如 果 机 器 人 处 于 “轻微 级 故障 报警 ”, 则 输出 端子 19 王 ON 


21 | 警告 型 故障 


表示 机 器 人 出 现 “ 警 告 型 故障 ” 


CLVLERR 


22 | 机 器 人 急 停 


表示 机 器 人 处 于 “ 急 停 状态 ” 


EMGERR 


参数 名 : CLVLERR ”机 器 号 : 0 


说 明 : No signal ,During Caution OUTPUT | 


1: -1 
2: 20 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =20, 如 果 机 器 人 处 于 “ 急 停 状态 ”, 则 输出 端子 20 王 ON 


第 NN 任务 区 程序 


23 
在 运行 中 


表示 “第 N 任务 区 程序 在 运行 中 ” 


SnSTART 


参数 名 : S1START ”机 器 号 : 0 


说 明 : Slott start INPUT ,Slott During Execute OUTPUT | 


-1 
2: 21 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 21, 如 果 机 器 人 处 于 “第 1 任务 区 程序 运行 状态 ”, 则 输出 端子 


21=ON 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


击 吕 恰 


30 日 学 烧 工 业 胡 器 人 


续 表 
序号 名 称 功 能 对 应 参数 出 厂 值 (端子 号 ) 
第 N 任务 区 程序 | -_-。 » 
24 在 暂停 中 表示 “第 N 任务 区 程序 在 暂停 中 SnSTOP 


参数 名 : S1STOP ”机 器 号 : 0 


说 明 : Slot1 STOP INPUT ,Slot1 During wait OUTPUT 


az -1 


2: 22 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 = 二 22, 如 果 机 器 人 处 于 “第 1 任务 区 程序 暂停 中 状态 ”, 则 输出 端子 


22=ON 
合 
二 | 千林 全 疝 可 人 多 表示 “第 N 台 机 器 人 伺服 OFF” SnSRVOFF 
服 OFF 
26 本 De 志学 信介 表示 “第 N 台 机 器 人 伺服 ON” SnSRVON 
第 N 台 机 器 人 机 | 表示 “第 N 台 机 器 人 处 于 机 械 锁 定 ” 
2 横 锁 定 状态 SnMELOCK 
对 应 于 数据 输出 ,指定 输出 信号 的 “起 
28 | 数据 输出 地 址 号 始 位 ww 结束 位 IODATA 
参数 的 编辑 


参数 名 : IODATA 机 器 号 : 0 


说 明 ，value input signal (start,end)INPUT ,value output signal (start,end) OUTPUT 


-1 


24 
31 


了 
2: -1 
3 
4 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =24 一 31, 则 输出 端子 24 一 31 的 ON/OFF 状态 构成 了 一 组 数据 


20 | 时 扣 输 | 表示 当前 正在 给 出 "可 序号 " 


PRGOUT 


参数 名 : PRGOUT 机 要 号 : 0 


说 明 : prog.No. output requirement INPUT, During output prog.No. OUTPUT | 


下 -1 
2 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 一 32, 如 果 机 器 人 当前 正在 输出 “程序 号 ”, 则 输出 端子 32 一 ON 


序号 名 称 功 能 


续 表 
出 厂 值 (端子 号 ) 


30 和 数据 箱 | 表示 当前 正在 输出 “程序 行 号 " 


人 参数 名 : LINEOUT ”机 器 号 : 0 


说 明 : line No. output requirementINPUT, During output line No. OUTPUT 


i -1 
2: 33 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 = 二 33, 如 果 机 器 人 当前 正在 输出 “程序 行 号 ”, 则 输出 端子 33 二 ON 


3l ee 表示 当前 正在 输出 “速度 比例 * 


OVRDOUT 


参数 名 : OVRDOUT ”机 器 号 : 0 


说 明 : OVRD output requirement INPUT, During output OVRD OUTPUT 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 34, 如 果 机 器 人 当前 正在 输出 “速度 比例 ”, 则 输出 端子 34 二 ON 


32 |“ 报 警号 ?输出 中 | 表示 当前 正在 输出 “报警 号 ” 


ERROUT 


参数 的 编辑 


参数 名 : ERROUT ”机 器 号 : 0 


说 明 : Err.No. output requirement INPUT, During output Err.No OUTPUT 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 ==35, 如 果 机 器 人 当前 正在 输出 “报警 号 ”, 则 输出 端子 35 二 ON 


33 | JOG 有 效 状态 表示 当前 处 于 “JOG 有 效 状态 ” 


JOGENA 


参数 名 : JOGENA “机 可 号 : 0 


说 明 : JOG command INPUT, During JOG OUTPUT 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =36, 如 果 机 器 人 当前 处 于 *JOG 有 效 状 态 ”, 则 输出 端子 36 一 ON 


第 
5 
章 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 烧 工 业 胡 器 人 


序号 


名 称 


功 能 


续 表 


出 厂 值 (端子 号 ) 


34 


JOG 模式 


表示 当前 的 “JOG 模式 ” 


参数 名 : JOGM 机 器 号 : 0 


说 明 : JOG MODE specifiction(start end)INPUT JOG mode output (start,end) | 


UTPUT 


-1 


37 


于 
和 = 
3 
4 


39 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 王 37 一 39, 输 出 端子 37 一 39 构成 的 数据 表示 了 JOG 的 工作 模式 


35 


JOG 报警 无 效 


状态 


JOG 报警 无 效 状态 


JOGNER 


套数 的 编辑 


参数 名 : ERROUT ”机 器 号 : 0 


说 明 : Err.No. output requirement INPUT, During output Err.No OUTPUT 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 = 二 40, 如 果 机 器 人 当前 处 于 “JOG 报警 无 效 状态 ”, 则 输出 端子 


40=ON 
输出 抓 手 工作 状态 
态 
36 | 抓 手工 作 状 (输出 信号 部 分 ) HNDCNTLn 
输出 抓 手 工作 状态 
37 | 抓 手 工作 状态 (输入 信号 部 分 ) HNDSTSn 
外 部 信号 对 抓 手 控 | ,wie 
38 | 制 的 有 效 /无 效 表示 “外 部 信号 对 抓 手 控制 的 有 效 /无 ANDENA 
效 状态 ” 
状态 
| 六 的 入 各 ] 


参数 名 : HANDNER ”机 器 号 : 0 


说 明 : Hand control enable INPUT ,Hand control enable OUTPUT 


二 和 
县 2 


42 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 一 42, 如 果 机 器 人 当前 处 于 “外 部 信号 对 抓 手 控制 有 效 状 态 ”, 则 输 


出 端子 


42 王 ON 


续 表 


序号 名 称 功 能 对 应 参数 。 “| 出 厂 值 (端子 号 ) 
第 N 台 机 器 人 抓 | » 
39 手 报警 表示 “第 N 台 机 器 人 抓 手 报警 HNDERRn 
ET 


参数 名 : HANDNRR1 机 器 号 :0 | 


说 明 : Robort Hand error requirement INPUT ,During robort1 hand error 
OUTPUT 


下 -1 
2: 43 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =43 ,如果 1# 机 器 人 当前 处 于 “ 抓 手 报警 ”, 则 输出 端子 13 二 ON 


第 N 台 机 器 人 气 | ，_。 车 本 
40 压 报警 表示 “第 N 台 机 器 人 气压 报警 AIRERRn 


套数 的 编辑 


| 参数 名 : AIRERR1 机 可 号 :0 


说 明 : Robort1 air pressure error INPUT ,During robort1 at pressure error 
OUTPUT 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 = 二 45, 如果 1# 机 器 人 当前 处 于 “气压 报警 状态 ”, 则 输出 端子 
45 一 ON 


用 输出 端子 “起 始 位 “结束 位 ”表示 “用 
41 | 用 户 定义 区 编号 户 定义 区 编号 ” USRAREA 


会 数 的 编辑 
参数 名 : USRAREA 机 器 号 : 0 


说 明 : No signal , with user defined area (start end)OUTPUT 


1: 
2: 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 一 46 一 48 ,输出 端子 46 一 48 构成 的 数据 表示 了 “用 户 定义 区 编号 ” 


42 | 易 损 件 维修 时 间 表示 易 损 件 到 达 “ 维 修 时 间 ” MnPTEXC 


套数 的 编辑 
参数 名 : M1PTEXC 机 可 号 : 0 


说 明 : No signal , robot1 waming which urges exchange of parts 


1 ro. 
本 49 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 49, 如 果 机 器 人 易 损 件 到 达 “ 维 修 时 间 ”, 则 输出 端子 49 二 ON 


地 中 器 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 烧 工 业 胡 器 人 


续 表 
序号 名 称 功 能 对 应 参数 。 | 出 厂 值 (端子 号 ) 
机 器 人 处 于 “ 预 热 be 吕 
43 工作 模式 ” 表示 “机 器 人 处 于 预 热 工 作 模式 MnWUPENA 
E77 


套数 名 :M1WUPENA 机 器 号 :0 | 


说 明 : robot1 warm up mode setting IUPUT, robott warm up mode enable 
OUTPUT 


1: -1 
a 50 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 50, 如 果 机 器 人 处 于 “ 预 热 工作 模式 ”, 则 输出 端子 50 一 ON 
输出 位 置 数据 的 任 | 用 输出 端子 “起 始 位 ”结束 位 ”表示 “ 输 


44 


务 区 编号 出 位 置 数据 的 任务 区 编号 ” SUT 
[| 


参数 名 : PSSLOT 机 器 号 ， 0 | 


说 明 :Slot number (start,end)INPUT ,Slot num ber (start,end) OUTPUT 


= 
2: = 
3 51 
4 53 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =51 一 53 ,输出 端子 51 一 53 构成 的 数据 表示 了 “输出 位 置 数据 的 任 
务 区 编号 ” 


加 输出 的 “位 置 数据 | 表示 输出 的 “位 置 数据 类 型 ?是 关节 型 
类 型 ” 还 是 直 交 型 
会 效 的 编辑 。 | 


参数 名 : PSTYPE 机 器 号 : 0 


PSTYPE 


说 明 : Data type number INPUT ,Data type number OUTPUT | 


[ -1 
于 5 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 54, 如 果 “ 位 置 数 据 类 型 = 关节 型 ”, 则 输出 端子 54 二 ON。 如 果 
“位 置 数 据 类 型 == 直 交 型 ”, 则 输出 端子 54 一 OFF 
输出 的 “位 置 数据 | 用 输出 端子 “起 始 位 ”结束 位 ?表示 “ 输 
编号 ” 出 位 置 数据 的 编号 ” 


46 PSNUM 


参数 的 编辑 


参数 名 : PSNUM 机 器 号 :0 ] 


说 明 : Position number sartend)INPUT ,position number (startend) OUTPUT 


1: 
> 34 
3 
4 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 二 40 一 44, 输 出 端子 40 一 44 构成 的 数据 表示 了 “输出 位 置 数据 的 编号 ” 


续 表 


序号 名 称 功 能 对 应 参数 出 厂 值 (端子 号 ) 
“位 置 数据 ”的 输出 | 表示 当前 是 否 处 于 “位 置 数据 的 输出 状 ee 

状态 态 ” 
E> TTT 


参数 名 : PSOUT ”机 器 号 : 0 


说 明 : Position data requirement INPUT ,During output position OUTPUT | 


Ws -1 
2: 55 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 =55, 如 果 机 器 人 当前 处 于 “位 置 数据 的 输出 状态 ”, 则 输出 端子 
55=ON 


0 i 表示 当前 处 于 “控制 柜 温度 输出 状态 ” | TMPOUT 
| 和 数 的 编辑 | 


参数 名 : TMPOUT 机 器 号 : 0 


说 明 : Temperature in RC output requirement INPUT ,During Temperature 
inRC OUTPUT 


日 9 | 
7 | 


图 中 ,设置 对 应 本 功能 的 输出 端子 号 = 二 7, 如 果 机 器 人 当前 处 于 “控制 柜 温度 输出 状态 ”, 则 输出 端子 
7=ON 


5.4 ”初步 学 习 RT ToolBox2 软件 


RT ToolBox2 软件 (以 下 简称 RT) 是 一 款 专门 用 于 三 菱 机 器 人 编程 .参数 设置 .程序 调 
试 .工作 状态 监视 的 软件 ,其 功能 强大 ,编程 方便 。RT ToolBox2 软件 可 以 在 官网 上 下 载 。 
本 章 先 对 RT 软件 的 使 用 做 一 简明 的 介绍 ,在 本 书 的 第 30 章 中 将 有 详细 介绍 。 

设置 具体 参数 的 操作 方法 如 下 。 

单 击 “离线 ”参数 "一 “信号 参数 "一 “专用 输入 输出 信号 分 配 ?-~“* 通 用 1”, 弹 出 如 
图 5-2 所 示 的 专用 输入 输出 信号 设置 框 。 在 专用 输入 输出 信号 设置 框 内 ,可 以 设置 相关 的 
输入 输出 信号 。 

这 一 部 分 是 最 常用 的 参数 设置 界面 。 可 以 在 这 个 窗口 中 直接 设置 。 这 个 窗口 的 设置 内 
容 比 较 集中 ,也 可 以 如 同 5. 3. 2 节 所 示 ,直接 打开 对 应 的 参数 ,进行 设置 。 关 于 参数 的 学 习 
要 在 第 16 一 18 章 进行 。 在 这 些 章节 中 ,对 参数 进行 了 专门 的 解释 。 


击 吕 恰 


第 5 日 一 一 机 器 人 系统 的 输入 输出 信号 


30 日 学 烧 工 业 机 器 人 


5-2 ”专用 输入 输出 信号 设置 框 


5.5 需要 思考 的 问题 


(1) 输入 输出 端子 的 序号 与 功能 的 关系 是 固定 的 吗 ? 

(2) 输入 信号 START 与 输出 信号 START 有 什么 区 别 ? 
(3) 输入 信号 “操作 权 ” 有 什么 功能 ? 

(4)“ 程 序 复位 ”输入 信号 有 什么 功能 ? 

(5) 试用 “ 示 教 单元 ”设置 输入 信号 START。 


第 6 章 第 6 日 一 一 简单 的 运动 指令 


【学 习 目 的 】 

在 第 3 日 的 学 习 中 ,虽然 已 经 让 机 器 人 动 起 来 了 ,但 只 是 一 种 手动 操作 ,机 器 人 的 自动 
运行 才 是 学 习 的 目的 。 为 了 让 机 器 人 自动 运行 ,必须 学 会 编写 程序 。 本 章 的 学 习 目 的 是 学 
习 一 些 最 简单 的 指令 ,这 些 指令 是 构成 自动 程序 的 基础 。 


6.1 关节 插 补 指令 


“关节 插 补 ” 是 机 器 人 运动 的 一 种 最 常见 的 方式 。 机 器 人 在 从 “起 点 (当前 点 )” 向 “终点 ” 
运行 时 ,以 各 轴 等 量 旋转 角度 的 联动 方式 实现 从 “起 点 (当前 点 )” 到 达 “ 终 点 ”, 其 运行 轨迹 无 
法 确切 描述 。“ 关 节 持 补 ” 是 机 器 人 最 常用 的 运动 方式 。 

1. 关节 插 补 的 指令 格式 

Mov < 终点 >[,< 近 点 >][ 轨 迹 类 型 Type < 常数 1 >, Type < 常数 2>][< 附 随 语句 >] 

2. 例句 


Mov (Plt 1,10), 100 Wth M Out(17)=1 


3. 说 明 

MOYV 语句 是 关节 插 补 指令 ,从 “当前 点 ”移动 到 “终点 ”。 

(1) 终点 指 “ 目 标点 ”。 

(2)“ 近 点 ” 指 接近 “终点 ”的 一 个 点 。 在 实际 工作 中 ,往往 需要 快 进 到 终点 的 附近 , 青 慢 
速 运动 到 终点 。“ 近 点 ”在 “终点 ”的 Z 轴 方 向 位 置 。 根 据 符号 确定 是 上 方 或 下 方 。 使 用 近 
点 设置 ,是 一 种 快速 定位 的 方法 。“ 近 点 ”是 “ 快 进 ” 与 慢 进 " 的 分 界 点 。 

(3)“ 类 型 常数 Type” 用 于 设置 运行 轨迹 。 

“类 型 常数 Type 1” 二 1: 绕 行 。 

@@ “类 型 常数 Type 1" 一 0: 捷径 运行 。 

“ 线 行 ”是 指 按 示 教 轨迹 ,可 能 大 于 180" 轨 迹 运行 “捷径 ? 指 按 最 短 轨迹 , 即 小 于 180” 
轨迹 运行 。 

(4) 附 随 语句 。 

附 随 语句 如 Wth、IFWITH , 指 在 执行 MOV 指令 时 ,同时 执行 其 他 的 指令 。 

4. 样 例 程序 

以 下 程序 中 , 单 引 号 以 后 的 部 分 是 注释 ,可 做 中 文 注释 。 


30 日 学 嵌 工 业 胡 器 人 


Mov P1 一 一 移动 到 P1 点 。 
Mov P1 十 P2 一 一 移动 到 P1 十 P2 的 位 置 点 。 
Mov P1 * P2 ?一 一 移动 到 P1 * P2 位 置 点 (位 置 点 乘法 ) 。 
Mov P1 ,一 50 ”一 一 移动 到 P1 点 上 方 50mm 的 “ 近 点 ”。 
Mov P1 Wth M_Out(17)==1’ 一 一 向 Pl 点 移动 同时 指令 输出 信号 (17)=ON 。 
Mov P1 WthIf M_In(20) 二 1,Skip’ 一 一 向 Pl 点 移动 的 同时 ,如 果 输 入 信和 号 (20) 一 
ON ,就 跳 到 下 一 行 。 
Mov Pl Type 1,0” 一 一 指定 运行 轨迹 类 型 为 “捷径 型 。 
如 图 6-1 所 示 的 移动 路 径 其 程序 如 下 。 
Mov Pl1 ' 一 一 移动 到 B1 点 。 
Mov P2，- 50 ' 一 一 移动 到 P2 点 上 方 50mm 位 置 点 即 " 近 点 "。 
Mov P2' 一 一 移动 到 P2 点 。 
Mov P3, 一 100, Wth M_Out(17) = 1 ' 一 一 移动 到 PB3 点 上 方 100mn 的 " 近 点 "位 置 ,同时 指令 输出 信号 
17) = ON。 
2 P3 ' 一 一 移动 到 P3 点 


6 Mov P3, - 100' 一 一 移动 到 P3 点 上 方 100mm 位 置 点 。 
7 End' 程序 结束 。 


注意 : 近 点 位 置 以 TOOL 坐标 系 的 Z 轴 方 向 确定 。 
抓 手 
中 -一 机 器 人 运行 轨迹 


Pl e9 动作 位 
Se oO 
A 


CO 一 一 


必 w N 


[他 
SNO 


E (5) 
(4) 将 输出 信号 位 
17=ON \ 


图 6-1 程序 及 移动 路 径 


6.2 “直线 插 补 ”指令 


“直线 插 补 ” 是 从 “当前 点 ”向 “终点 ”运动 的 形式 。 其 特点 是 运行 轨迹 为 直线 。 这 是 与 关 
节 插 补 MOV 指令 最 大 的 不 同 之 处 。 直 线 插 补 的 运动 指令 为 Mvs。 在 需要 有 明确 的 直线 
运动 轨迹 时 ,必须 使 用 直线 插 补 指令 。 

1. 指令 格式 1 

Mvs ”< 终点 >,< 近 点 距离 >, [< 轨迹 类 型 常数 1 >,< 插 补 类 型 常数 2>][< 附 随 语句 >] 

2. 指令 格式 2 


Mvs < 离开 距离 > [< 轨迹 类 型 常数 Typel >,< 插 补 类 型 常数 2>][< 附 随 语句 >] 


注意 : 这 是 从 “终点 ”退回 * 近 点 ”使 用 的 简易 指令 格式 。 

3. 对 指令 格式 的 说 明 

(1) < 终点 >: 目标 位 置 点 。 

(2) < 近 点 距离 >: 以 TOOL 坐标 系 的 Z 轴 为 基准 ,到 “终点 ”的 距离 。 

(3) < 轨迹 类 型 常数 Typel >, 常 数 1 二 1, 绕 行 ; 常数 1 二 0, 捷 径 运 行 。 

(4) 插 补 类 型 : 常数 二 0, 关 节 插 补 ; 常数 二 1, 直 角 持 补 ; 常数 二 2, 通 过 特异 点 。 

(5) < 离开 距离 >: 在 指令 格式 2 中 的 离开 距离 是 以 TOOL 坐标 系 的 Z 轴 为 基准 ,离开 
“终点 ”的 距离 。 这 是 一 个 便捷 指令 。 

插 补 指令 的 运行 轨迹 如 图 6-2 所 示 。 

Mvs P1,-100 wa[ To 
4 当前 位 置 

pl 100mm 


当前 位 省 当前 位 置 
当前 位 置 


Mvs P1 


1 


Pl 


6-2 ”Myvs 指令 的 移动 轨迹 


4. 指令 例句 1 
向 终点 做 直线 运动 。 


1 MvsPl 


5. 指令 例句 2 
向 “接近 点 ”做 直线 运动 ,实际 到 达 * 接 近 点 ”, 同 时 指令 输出 信号 (17) 一 on。 


1 MvsPl,—100.0 WthM Out(17)=1 


6. 指令 例句 3 


输入 信号 (18) 二 ON, 则 指令 输出 信号 (20) 二 ON。 
1 Mvs PA4+P5, 50.0 WthIf M In(18) =1, M Out(20)=1 


7. 指令 例句 4 
从 当前 点 , 沿 TOOL 坐标 系 Z 轴 方向 移动 100mm: 


Mvs,—100 


6.3 “ 真 圆 插 补 ” 指 令 


“ 真 圆 插 补 ?是 指 机 器 人 的 运行 轨迹 为 一 真 圆 。 

三 维 真 圆 插 补 指令 格式 为 : Mvc(Move C) 。 说 明 如 下 。 

1. 功能 

Mvc 指令 的 运动 轨迹 是 一 完整 的 真 圆 。 需 要 指定 起 点 和 圆 弧 中 的 两 个 点 。 运 动 轨迹 


第 6 日 一 一 简章 的 运动 指 售 


震中 泪 


30 日 学 烧 工 业 夫 器 人 


如 图 6-3 所 示 。 


MveP1, P2, P3 PBP2 
当前 位 置 @ 
、 


、 
、 


直线 插 补 \ 
Pl 


图 6-3 Mvc 一 一 三 维 真 圆 插 补 指令 的 运行 轨迹 
2. 指令 格式 
Mvc < 起 点 >,< 通 过 点 1>, < 通过 点 2> 附 随 语句 


3. 术语 

(1) < 起 点 >,< 通 过 点 1 >,< 通 过 点 2 > 是 圆 弧 上 的 三 个 点 。 

(2) < 起 点 >: 真 圆 的 “起 点 "和 "终点 ”。 

4. 运动 轨迹 

从 “当前 点 ”开始 到 Pl 点 ,是 直线 轨迹 。 真 圆 运动 轨迹 为 Pl 一 P2 一 P3 一 P1。 
5. 指令 例句 

1 Mvc P1,P2,P3' 一 一 真 圆 插 补 。 

2 Mvc P1,J2,P3' 一 一 真 圆 插 补 。 

3 Mvc P1,P2,P3 Wth M_Out(17) = 1' 一 一 真 圆 插 补 同时 输出 信号 17 = ON。 

4 Mvc P3, (Plt 1,5),P4 WthIf M_In(20) =1,M Out(21) = 1' 一 一 真 圆 插 补 同时 如 果 输 入 信号 20 = 1, 则 
输出 信号 21 = ON。 

6. 说 明 

(1) Mvc 指令 的 运动 轨迹 是 由 指定 的 三 个 点 构成 完整 的 真 圆 。 

(2) 圆 弧 插 补 的 “ 形 位 ”为 起 点 “ 形 位 ”。 通 过 其 余 两 点 的 “ 形 位 ”不计 。 

(3) 从 “当前 点 "开始 到 P1 点 ,是 直线 插 补 轨迹 。 


6.4 启动 和 停止 信号 


在 将 以 上 的 指令 输入 机 器 人 控制 器 后 ,如 何 发 出 “启动 信号 ”和 “停止 信号 ” 呢 ? 这 必须 
给 输入 输出 端子 赋予 功能 ,没有 赋予 "功能 ?之 前 ,即使 输入 输出 端子 已 经 接线 完毕 ,仍然 是 
“空白 ”的 。 对 输入 输出 端子 赋予 功能 的 方法 是 使 用 RT 软件 进行 设置 ,操作 方法 如 下 。 

(1) 将 计算 机 连接 到 “机 器 人 控制 器 ,打开 RT 软件 ”。 

(2) 单 击 “ 离 线 ”>“ 参 数 ”>“ 信 号 参数 ”>“ 专 用 输入 输出 信号 分 配 ”>“ 通 用 1”, 弹 出 如 
图 6-4 所 示 的 专用 输入 输出 信号 设置 框 ,在 专用 输入 输出 信号 设置 框 内 ,可 以 设置 相关 的 输 
入 输出 信号 。 

(3) 如 图 6-5 所 示 ,将 输入 信号 端子 3 设置 为 “启动 ”; 将 输入 信号 端子 0 设置 为 “ 停 
止 "。 将 这 两 个 输入 信号 分 别 与 操作 面板 上 的 按钮 开关 相连 接 。 

(4) 在 安全 状态 下 , 按 下 “启动 ”按钮 和 “停止 "按钮 ,观察 运动 状态 。 


图 6-5 设置 输入 输出 信号 


6.5 实 验 
(1) 编制 一 段 运 动 程序 ,如 图 6-6 所 示 。 


抓 手 
中 < 一 机 器 人 的 动作 


Bi eo 动作 位 置 
”3 
Oo -一 一 人 包 


人 总 


(4) 将 输出 信号 位 
17 开 启 Am 
6-6 ”程序 及 移动 路 径 


(2) 参照 4.4 节 , 示 教 确定 P1、P2、P3 点 。 
(3) 设置 输入 信号 “启动 "和 “停止 ”。 
(4) 在 安全 状态 下 (将 “ 急 停 ”按钮 置 于 控制 范围 ) ,将 速度 倍率 设置 =10, 发 出 “启动 "和 


第 6 日 一 一 阅 单 的 运动 指令 


击 吕 溃 


30 日 学 烧 工 业 机 器 人 


“停止 ?信号 ,观察 运动 轨迹 。 

(5) 重新 设置 输入 信号 “启动 "和 “停止 "。 例 如 ,设置 “启动 ”=4,“ 停 止 ”"=9, 观 察 机 器 
人 运动 状态 。 

如 图 6-1 所 示 的 移动 路 径 其 程序 如 下 。 


Mov Pl1 一 一 移动 到 Pl 点 。 

Mov P2,，- 50 ' 一 一 移动 到 P2 点 上 方 50mm 位 置 点 即 " 近 点 "。 

Mov P2 ' 一 一 移动 到 P2 点 。 

Mov P3, 一 100, Wth M_Out(17) =1' 一 一 移动 到 P3 点 上 方 100mn 的 " 近 点 "位 置 ,同时 指令 输出 信号 
(17) = ON。 

5 Mov P3' 一 一 移动 到 P3 点 。 

6 Mov P3, -100' 一 一 移动 到 P3 点 上 方 100mm 位 置 点 。 

7 End' 程序 结束 。 


ww N 


6.6 需要 思考 的 问题 


(1) 什么 是 插 补 运行 ? 

(2)“MOYV 指令 ”与 “Mvs 指令 ”都 是 点 对 点 的 运动 指令 ,这 两 个 指令 有 什么 区 别 ? 
(3) 什么 是 “ 近 点 ”? 为 什么 通常 要 使 用 * 近 点 ”? 

(4) 如 何 确定 各 个 点 的 位 置 ? 

(5) 如 何 设置 输入 输出 信号 的 功能 ? 


第 7 章 第 7 日 一 机 器 人 的 坐标 系 


【学 习 目 的 】 

在 第 6 章 的 学 习 中 ,通过 简短 的 程序 已 经 使 机 器 人 运动 起 来 ,但 是 各 个 位 置 点 的 基准 在 
哪里 呢 ? 换 句 话 说 ,机 器 人 是 按照 什么 样 的 坐标 系 运动 的 呢 ? 在 一 般 的 运动 机 械 中 ,都 是 按 
照 直 角 坐 标 系 运动 。 直 角 坐 标 系 的 原点 由 机 床上 的 某 个 基准 点 确定 。 机 器 人 也 是 运动 机 
械 , 机 器 人 的 坐标 系 如 何 确定 呢 ? 本 章 就 是 要 学 习 机 器 人 的 坐标 系 。 由 于 机 器 人 结构 的 特 
殊 性 ,机 器 人 所 使 用 的 坐标 系 比 一 般 工作 机 械 要 复杂 些 , 但 是 使 用 不 同 的 坐标 系 本 身 还 是 要 
使 机 器 人 的 运动 编程 更 简单 。 


7.1 基本 坐标 系 


基本 坐标 系 是 以 机 器 人 底座 安装 基 面 为 基准 的 坐标 系 。 在 机 器 人 底座 上 有 图 示 标 志 。 
基本 坐标 系 如 图 7-1 所 示 。 实 际 上 ,基本 坐标 系 ? 是 机 器 人 的 第 一 基准 坐标 系 “ 世 界 坐 标 
系 ” 也 是 以 “基本 坐标 系 ” 为 基准 的 。 


7-1 基本 坐标 系 


当 机 器 人 的 安装 位 置 确定 以 后 “基本 坐标 系 ” 就 确定 了 。“ 基 本 坐标 系 " 是 机 器 人 诸多 
坐标 系 的 基准 。 


二 


30 日 学 烧 工 业 夫 器 人 


7.2 世界 坐标 系 


“世界 坐标 系 ” 是 机 器 人 系统 默认 使 用 的 坐标 系 ,是 表示 机 器 人 (控制 点 ) 位 置 的 “当前 坐 
标 系 ”。 所 有 表示 位 置 点 的 数据 都 是 以 “世界 坐标 系 ” 为 基准 的 。(“ 世 界 坐 标 系 ” 类 似 于 数控 
系统 的 G54 坐标 系 ,事实 上 就 是 “工件 坐标 系 ”。) 

“世界 坐标 系 ”是 以 机 器 人 的 “基本 坐标 系 ” 为 基准 设置 的 (这 是 因为 每 一 台 机 器 人 的 “ 基 
本 坐标 系 ” 是 由 其 安装 位 置 决定 的 )。 只 是 确定 “世界 坐标 系 ”基准 点 时 ,是 从 “世界 坐标 系 ” 
来 观察 基本 坐标 系 ”的 位 置 , 从 而 确定 新 的 “世界 坐标 系 ” 本 身 的 基准 点 ,所 以 “基本 坐标 系 ” 
是 机 器 人 坐标 系 中 第 1 基准 坐标 系 。 

在 大 部 分 的 应 用 中 光世 界 坐标 系 ” 与 “基本 坐标 系 ”" 相 同 。 

如 图 7-2 所 示 ,图 中 XwYwZw 是 “世界 坐标 系 ”。 当 前 位 置 是 以 世界 坐标 系 为 基准 的 ， 
如 图 7-3 所 示 。 


世界 坐标 系 


图 7-2 “世界 坐标 系 ”与 “基本 坐标 系 ” 之 间 的 关系 图 7-3 “当前 位 置 ”以 “世界 坐标 系 ”为 基准 


7.3 ”机械 IF 坐标 系 


“机 械 IF 坐标 系 ? 也 就 是 “机 械 法 兰 面 坐标 系 "。 以 机 器 人 最 前 端 法 兰 面 为 基准 确定 的 
坐标 系 称 为 “机械 IF 坐标 系 ”, 以 Xm-Ym-Zm 表示 ,如 
图 7-4 所 示 。 与 法 兰 面 垂直 的 轴 为 “Z 轴 ”,Z 轴 正 向 朝 
外 ,Xm 轴 、Ym 轴 在 法 兰 面 上 。 法 兰 中 心 与 定位 销 孔 
的 连接 线 为 Xm 轴 , 但 必须 注意 Xm 轴 的 “ 正 向 ”与 定位 
销 孔 相反 。 

由 于 在 机 械 法 兰 面 要 安装 抓 手 ,所 以 这 个 “机 械 法 
兰 面 "就 具有 特殊 意义 。 特 别 注意 : 机 械 法 兰 面 转动 ， 
图 7-4 ”机械 下 坐标 系 的 定义 机 械 IF 坐标 系 也 随 之 转动 。 而 法 兰 面 的 转动 受 J4 和 


J6 轴 的 影响 (特别 是 J6 轴 的 旋转 带动 了 法 兰 面 的 旋转 ,也 就 带动 了 机 械 IF 坐标 系 的 旋转 ， 
如 果 以 机 械 IF 坐标 系 为 基准 执行 定位 ,就 会 影响 很 大 ) ,参见 图 7-5 和 图 7-6。 图 7-6 是 J6 
轴 逆 时 针 旋 转 了 的 坐标 系 。 


图 7-5 机 械 IF 坐标 系 的 图 示 图 7-6 J6 轴 逆 时 针 旋 转 了 的 机 械 IF 坐标 系 


7.4 TOOL 坐标 系 


7.4.1 定义 及 设置 


工具 (TOOL) 坐 标 系 的 定义 及 设置 基准 如 下 。 

1. 定义 

由 于 实际 使 用 的 机 器 人 都 要 安装 夹具 抓 手 等 辅助 工具 ,所 以 ,机 器 人 的 实际 控制 点 就 移 
动 到 了 工具 的 中 心 点 上 ,为 了 控制 方便 ,以 工具 的 中 心 点 为 基准 建立 的 坐标 系 就 是 TOOL 
坐标 系 。 

2. 设置 

由 于 夹具 抓 手 直接 安装 在 机 械 法 兰 面 上 ,所 以 TOOL 坐标 系 就 是 以 机 械 IF 坐标 系 为 
基准 建立 的 。 建 立 TOOL 坐标 系 有 参数 设置 方法 和 指令 设置 法 ,实际 上 都 是 确定 TOOL 
坐标 系 原点 在 机 械 IF 坐标 系 中 的 位 置 和 形 位 。 

TOOL 坐标 系 与 机 械 IF 坐标 系 的 关系 如 图 7-7 所 示 。TOOL 坐标 系 用 Xt、Yt、Zt 表 


《机械 IF 坐 标 系 ) 


a Ym 


a 
Yt 


(TooL 生 奈 系 ) 


Xt 


图 7-7 工具 坐标 系 与 机 械 IF 坐标 系 的 关系 
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示 。TOOL 坐标 系 是 在 机 械 IF 坐标 系 基 础 上 建立 的 。 在 TOOL 坐标 系 的 原点 数据 中 ， 
XYZ 表示 TOOL 坐标 系 原点 在 机 械 IF 坐标 系 内 的 直 交 位 置 点 。ABC 表示 TOOL 坐标 系 
绕 机 械 IF 坐标 系 Xm、Ym、Zm 轴 的 旋转 角度 。 

TOOL 坐标 系 的 原点 不 仅 可 以 设置 在 “任何 位置 ,而 且 坐 标 系 的 形 位 也 可 以 通过 ABC 
值 任意 设置 (相当 于 一 个 立方 体 在 一 个 万 向 轴 接 点 任意 旋转 ) 。 在 图 7-7 中 ,TOOL 坐标 系 
绕 立 轴 旋 转 了 一 90", 所 以 Zt 轴 方 向 就 朝 上 (与 机 械 IF 坐标 系 中 的 Zm 方向 不 同 ) 。 而 且 当 
机 械 法 兰 面 旋转 (J6 轴 旋 转 ) 时 ,TOOL 坐标 系 也 会 随 着 旋转 ,分 析 时 要 特别 注意 。 


7.4.2 动作 比较 


1. JOG 或 示 教 动作 

1) 使 用 机 械 IF 坐标 系 

未 设置 TOOL 坐标 系 时 ,使 用 机 械 IF 坐标 系 以 出 厂 值 法 兰 面 的 中 心 为 “控制 点 ”, 在 X 
方向 移动 (此 时 ,X 轴 垂 直 向 下 ) ,其 移动 形 位 如 图 7-8 所 示 。 

2) 以 TOOL 坐标 系 动作 

设置 了 TOOL 坐标 系 后 ,以 TOOL 坐标 系 动 作 。 注 意 在 X 方向 移动 时 ,是 沿 着 TOOL 
坐标 系 的 Xt 方向 动作 ,这 样 就 可 以 平行 或 垂直 于 抓 手 面 动作 ,使 JOG 动作 更 简单 易 行 ,如 
图 7-9 所 示 。 


沿 着 机 械 UF 坐 标 系 Xm 轴 动 作 


沿 着 TOOL 坐 标 系 的 Xt 负 
xm 动作 ， 可 平行 /垂直 于 抓 手 
面 动作 ， 并 配合 工件 朝向 
图 7-8 XX 方向 移动 的 形 位 图 7-9 在 TOOL 坐标 系 X 方 向 移动 
3) A 方向 动作 


(1) 使 用 机 械 IF 坐标 系 

未 设置 TOOL 坐标 系 时 ,使 用 机 械 IF 坐标 系 , 绕 Xm 轴 旋 转 , 抓 手 前 端 大 幅度 摆动 ,如 
图 7-10 所 示 。 

(2) 设置 TOOL 坐标 系 绕 Xt 轴 旋 转 

设置 TOOL 坐标 系 后 , 绕 Xt 轴 旋 转 , 抓 手 前 端 绕 工件 旋转 ,在 不 偏离 工件 位 置 的 情况 
下 ,改变 机 器 人 形 位 ,如 图 7-11 所 示 。 

以 上 是 在 JOG 运行 时 的 情况 。 


A 方 向 移动 


A 方向 移动 


1 Ym 


TOOL 坐 标 系 的 Xt 轴 旋转 。 
变 为 以 抓 手 前 端 为 中 心 的 旋转 
Xm 机 械 IF 坐标 系 的 Xm 轴 旋 动作 ， 可 在 不 偏离 工件 位 置 的 
转 ， 抓 手 前 端 大 幅 移动 情况 下 变更 姿势 
图 7-10 A 方向 的 动作 图 7-11 在 TOOL 坐标 系 中 绕 Xt 轴 旋 转 

2. 自动 运行 

1) 近 点 运行 

在 自动 程序 运行 时 ,TOOL 坐标 系 的 原点 为 机 器 人 “控制 点 ”。 在 程序 中 发 出 的 定位 点 


是 以 世界 坐标 系 为 基准 的 。 但 是 , Mov 指令 中 的 近 点 运行 功能 中 的 “ 近 点 ”的 位 置 则 是 以 


TOOL 坐标 系 的 Z 轴 正 负 方 向 为 基准 移动 。 这 是 必须 注意 的 。 
指令 样 例 : 


1 Mov P1,50 


其 动作 是 : 将 TOOL 坐标 系 原点 移动 到 Pl1 点 的 “ 近 点 ”“ 近 点 ”为 Pl 点 沿 TOOL 坐标 系 的 


Z 轴 十 向 移动 50mm, 如 图 7-12 所 示 。 


BN 工件 


工件 搬运 位 置 一 一 一 
(位 置 : P1) 


图 7-12 在 TOOL 坐标 系 中 的 近 点 动作 
2) 相位 旋转 


绕 工 件 位 置 点 旋转 (Zb ,可 以 使 工件 旋转 一 个 角度 。 
例如 ,指令 在 Pl 点 绕 Z 轴 旋转 45"( 使 用 两 点 的 乘法 指令 ) 。 


1 Mov P1 * (0,0,0,0,0,45) 一 一 注意 : 使 用 两 点 的 乘法 指令 
实际 的 运动 结果 如 图 7-13 所 示 。 
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1. 参数 设置 法 


Zt 


(@) PI1 的 位 置 


(b) Mov P1*(0,0,0,0,0,45) 的 位 置 


7-13 在 TOOL 坐标 系 中 的 相位 旋转 


7.5 工件 坐标 系 


工件 坐标 系 是 以 工件 原点 确定 的 坐标 系 。 在 实际 加 工 中 ,工件 的 图 纸 是 绘制 完毕 的 。 
如 果 要 走出 工件 的 轨迹 ,当然 以 工件 尺寸 直接 编程 最 为 简捷 。 这 就 需要 一 个 以 工件 原点 为 
基准 的 坐标 系 ,这 就 是 工件 坐标 系 。 
在 机 器 人 系统 中 ,可 以 通过 参数 预先 设置 8 个 工件 坐标 系 。 


表 7-1 为 工件 坐标 系 相 关 参 数 ,可 在 软件 上 做 具体 设置 。 
表 7-1 工件 坐标 系 相 关 参 数 


类 参数 符号 参数 名 称 功 能 
动作 os 工件 坐标 系 设置 工件 坐标 系 
WKnWO 工件 坐标 系 原点 
WKnWX 工件 坐标 系 XX 轴 位 置 点 
WKnWY 工件 坐标 系 Y 轴 位 置 点 
设置 可 设置 8 个 工件 坐标 系 
2. 指令 设置 法 


设置 世界 坐标 系 的 偏 置 坐标 ( 偏 置 坐标 为 以 世界 坐标 系 为 基准 观察 到 的 基本 坐标 系 原 
点 在 世界 坐标 系 内 的 坐标 ) 。 


样 例 程序 如 下 。 


Base (50,100,0,0,0,90) 一 一 设置 一 个 新 的 世界 坐标 系 ( 如 图 7- 14 所 示 ) 。 
Mvs P1 ' 一 一 前 进 到 P1 点 。 

Base P2 一 一 以 P2 点 为 偏 置 量 ,设置 一 个 新 的 世界 坐标 系 。 

Mvs P1 前 进 到 Pl 点 。 

Base 0 设置 世界 坐标 系 与 基本 坐标 系 相 同 ( 回 初始 状态 )。 


世界 坐标 系 
Xw、Yw、Zw 


50 


AODcp 


Zw BASE (50. 100,0,0,90) 


7-14 使 用 Base 指令 设置 新 的 坐标 系 


3. 以 工件 坐标 系 号 选择 新 世界 坐标 系 的 方法 
样 例 程序 如 下 。 


Base 1 ' 一 一 选择 1# 工 件 坐 标 系 WK1CORD。 
Mvs Pl1' 一 一 运动 到 P1。 

Base 2' 一 一 选择 2# 工件 坐标 系 WK2CORD。 
Mvs P1 ' 一 一 运动 到 P1。 

Base 0 ' 一 一 选择 基本 坐标 系 。 


w wb 


7.6 需要 思考 的 问题 


(1) 基本 坐标 系 如 何 确定 ? 

(2) 世界 坐标 系 是 机 器 人 默认 使 用 的 坐标 系 吗 ? 世界 坐标 系 与 基本 坐标 系 有 什么 
关系 ? 

(3) 什么 是 坐标 系 偏 置 ? 

(4) 什么 是 机 械 IF 坐标 系 ? 如 何 确定 机 械 IF 坐标 系 的 原点 ? 

(5) TOOL 坐标 系 又 称 为 抓 手 坐标 系 吗 ?如何 设置 TOOL 坐标 系 ? 
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第 8 章 第 8 日 一 一 对 机 器 人 系统 的 初步 设置 


【学 习 目 的 】 

本 章 要 学 习 比 较 实 用 的 操作 。 实 际 上 任何 一 台 工作 机 械 在 运行 之 前 ,必须 选择 坐标 系 ， 
设置 原点 ,特别 是 要 设置 行程 范围 ,也 就 是 行程 限 位 ,以 保证 工作 机 械 在 正常 的 行程 范围 内 
工作 ,不 发 生 事故 。 机 器 人 由 于 其 特殊 性 有 多 种 原点 设置 和 行程 范围 设置 的 方法 。 这 就 是 
本 章 要 学 习 的 内 容 。 


8.1 坐标 系 的 选择 


在 第 7 章 中 介绍 了 机 器 人 使 用 的 各 种 坐标 系 。 而 世界 坐标 系 是 机 器 人 系统 默认 使 用 的 
坐标 系 , 因 此 如 果 不 在 程序 中 特别 指定 ,就 是 使 用 世界 坐标 系 。 如 果 不 特别 加 以 设置 ,世界 
坐标 系 与 基本 坐标 系 相同 。 


8.2 原点 的 设置 


8.2.1 设置 原点 的 方法 种 类 


在 开机 后 ,首先 必须 设置 原点 。 三 菱 机 器 人 有 以 下 6 种 设置 原点 方式 ,如 图 8-1 所 示 。 
(1) 原点 数据 输入 方式 ; 
(2) 机 械 限 位 器 方式 ; 
(3) 夹具 方式 ; 
ER 一 
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图 8-1 原点 数据 设置 框 


(4) ABS 原点 方式 ; 

(5) 用 户 原点 方式 ; 

(6) 原点 参数 备份 方式 。 

使 用 RT 软件 可 以 设置 原点 (参见 第 30 章 ) 。 

单 击 “ 维 护 ”>“ 原 点 数据 ”, 弹 出 如 图 8-1 所 示 原 点 数据 设置 框 。 


8.2.2 原点 数据 输入 方式 的 使 用 


原点 数据 输入 方式 一 一 直接 输入 “字符 串 ”, 这 是 最 常用 的 方法 。 

出 厂 时 ,厂家 已 经 标定 了 各 轴 的 原点 ,并 且 作 为 随机 文件 提供 给 使 用 者 。 一 方面 使 用 者 
在 使 用 前 应 该 输入 “原点 文件 ”一 一 原点 文件 中 每 一 轴 的 原点 是 一 个 “字符 串 ”, 使 用 者 应 该 
妥善 保存 “原点 文件 ”。 另 一 方面 ,如 果 原 点 数据 丢失 后 ,可 以 直接 输入 原点 文件 的 字符 串 ， 
以 恢复 原点 。 

本 操作 需要 在 联机 状态 下 操作 。 

(1) 打开 RT 软件 , 单 击 “ 维 护 ”>“ 原 点 数据 ”, 弹 出 如 图 8-1 所 示 原 点 数据 设置 框 。 

(2) 单 击 “ 原 点 数据 输入 方式 "按钮 ,弹出 如 图 8-2 所 示 “ 原 点 数据 的 设 定 ” 对 话 框 。 


8-2 原点 数据 输入 方式 一 一 直接 输入 字符 串 


(3) 根据 出 厂 文件 设置 ,输入 * 原 点 数据 ”。 

(4) 写 和 一 一 将 设置 完毕 的 数据 写 人 控制 器 。 

(5) 保存 文件 一 一 将 当前 原点 数据 保存 到 计算 机 中 。 

(6) 从 文件 读 出 一 一 从 计算 机 中 读 出 “原点 数据 文件 ”。 

(7) 更 新 一 一 从 控制 器 内 读 出 “原点 数据 ,显示 最 新 的 原点 数据 。 


8.3 机 器 人 初始 化 的 基本 操作 


(1) 功能 : 将 机 器 人 控制 器 中 的 数据 进行 初始 化 。 
可 对 下 列 信息 进行 初始 化 。 
中 时 间 设 定 ; 
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@ 删除 所 有 程序 ; 

@ 电池 剩余 时 间 的 初始 化 ; 

@ 控制 器 的 序列 号 的 确认 设 定 。 

(2) 操作 方法 如 图 8-3 所 示 。 

Q@ 打开 RT 软件 , 单 击 “ 维 护 ”>“ 初 始 化 ”, 弹 出 如 图 8-3 所 示 “ 初 始 化 ”设置 框 。 
@ 对 程序 进行 “初始 化 ”一 一 删除 控制 器 内 所 有 程序 。 

@ 设 定 “ 当 前 时 间 ”。 


2016/01/05 09:56:05 


图 8-3 初始 化 操作 框 


8.4 行程 范围 设置 


操作 方法 如 下 。 

单 击 “ 离 线 ” 一 “参数” 一“ 动作 参数 ”一 “动作 范围 ”弹出 如 图 8-4 所 示 的 动作 范围 设置 
框 。 在 动作 范围 设置 框 内 ,可 以 设置 各 轴 的 关节 动作 范围 ,在 直角 坐标 系 内 的 动作 范围 等 内 
容 , 既 明确 又 快捷 方便 。 


用 户 指定 原点 位 置 (l) (JSERORG) 。。 直 交 动作 范围 00 WEPAR) 
mmsdeg] -lm + 


J 0.00 X: -10000.00 10000.00 
J 00 ¥: -10000.00 10000.00 
33: m0 Z: -10000.00 10000.00 
2: 00 
25: 0.00 
;0.00 
37: oo 
= mene (5X% ] 


动作 范围 的 
具体 设置 


图 8-4 设置 具体 参数 


设置 完毕 后 , 单 击 “ 写 人 ?按钮 ,操作 完成 。 


8.5 需要 思考 的 问题 


(1) 机 器 人 默认 的 坐标 系 是 什么 坐标 系 ? 
(2) 如 何 设置 原点 ? 

(3) 如 何 进 行 初始 化 操作 ? 

(4) 如 何 用 角度 设置 动作 范围 ? 
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第 9 章 第 9 日 一 一 编程 指令 的 学 习 和 使 用 (1) 


【学 习 目 的 】 
经 过 前 面 8 章 的 学 习 ,读者 应 该 已 经 能 够 初步 使 用 机 器 人 了 。 本 章 以 后 要 学 习 更 多 更 
深 的 机 器 人 编程 指令 .状态 变量 参数 的 定义 及 设置 等 内 容 , 进 入 中 级 学 习 阶段 。 


9.1 三 维 圆 弧 插 补 指令 Mvr 


1. 功能 
Mvr 指令 为 三 维 圆 弧 持 补 指令 ,需要 指定 “起 点 "和 加 弧 中 的 “通过 点 "和 “终点”, 运动 
轨迹 是 一 段 圆 弧 , 如 图 9-1 所 示 。 


Mvr P1,P2, P3 


直线 插 补 移动 8 pI 
A P3 
当前 位 置 @ 
图 9-1 Mvr 指令 的 运动 轨迹 
2. 指令 格式 
Mvr < 起 点 >,< 通 过 点 >,< 终 点 >< 轨 迹 类 型 1 >, < 插 补 类 型 > 附 随 语句 


(1) < 起 点 >: 圆 弧 的 起 点 。 

(2) < 通过 点 >: 圆 弧 中 的 一 个 点 。 

(3) < 终点 >: 圆 弧 的 终点 。 

(4) < 轨迹 类 型 1 >: 规定 运行 轨迹 是 “捷径 ”还 是 “ 绕 行 ”"。 捷 径 ==0, 绕 行 =1。 

(5) < 插 补 类 型 >: 规定 “关节 插 补 ” 或 “三 轴 直 交 插 补 ”或 “通过 特异 点 ”"。 关 节 插 补 二 0， 
三 轴 直 交 插 补 二 1, 通 过 特异 点 二 2。 

3. 指令 例句 

1 Mvr P1,J2,P3' 一 一 圆 弧 插 补 。 

2 Mvr P1,P2,P3 Wth M_0ut(17) = 1' 一 一 圆 弧 插 补 , 同 时 指令 输出 信号 17 = ON。 


3 Mvr P3, (Plt 1,5),P4 WthIf M_ In(20) =1,M 0ut(21) = 1 一 一 圆 弧 插 补 , 同 时 如 果 输 入 信号 20= 1， 
则 输出 信号 21 = ON。 


9.2 “两 点 型 圆 弧 插 补 ”指令 


1. 功能 
Mvr2 指令 是 两 点 型 圆 弧 插 补 指令 ,需要 指定 “起 点 ”和 “终点 ”以 及 “参考 点 ”, 运 动 轨迹 
是 一 段 只 通过 起 点 和 终点 的 圆 弧 ,不 实际 通过 参考 点 (参考 点 的 作用 只 用 于 构成 圆 弧 轨迹 )， 
如 图 9-2 所 示 。 
Mvr2 P1,.P2, P3 Mvr2 P1.P2. P4 
P2 P2 
\ P4 < 
机 线 括 补 移动 pl pd 丰 找 搬 袍 动 PI 
当前 位 置 @ 一 当前 位 置 @ 


图 9-2 Movr2 指令 的 运动 轨迹 
2. 指令 格式 
Mvr2 ”< 起 点 > ，,< 终 点 >, < 参考 点 > 轨迹 类 型 , 插 补 类 型 ” 附 随 语句 


3. 说 明 

(1) 轨迹 类 型 : 常数 1 二 1, 绕 行 ; 常数 1=0, 捷 径 运行 。 

(2) 插 补 类 型 : 常数 二 0, 关 节 插 补 ; 常数 二 1, 直 交 插 补 ; 常数 二 2, 通 过 特异 点 。 

4. 指令 例句 

1 Mvr2 P1,P2,P3' 一 一 以 B1,P2,P3 点 做 圆 弧 插 补 。 

2 Mvr2 P1,J2,P3' 一 一 以 P1,J2,P3 点 做 圆 弧 插 补 。 

3 Mvr2 P1,P2,P3 Wth M_Out(17) =1' 一 一 以 P1,J2,P3 点 做 圆 弧 插 补 ,同时 指令 输出 信号 17 = ON。 

4 Mvr2 P3, (Plt 1,5),P4 WthIf M_In(20) =1,M Out(21) =1' 一 一 以 P3，(Plt 1,5),P4 点 做 圆 弧 插 
补 ,同时 如 果 输 入 信和 号 20 = ON, 则 指令 输出 信号 21 = ON。 


9.3 “三 点 型 圆 弧 插 补 ”指令 


1. 功能 
Mvr3 指令 是 三 点 圆 弧 持 补 指令 .需要 指定 起 点 和 终点 及 圆心 点 ,运动 轨迹 是 一 段 只 通 
过 起 点 和 终点 的 圆 弧 , 如 图 9-3 所 示 。 


MvrP1，P2，P3 


当前 位 P2 
ev -一 >e 
直线 插 补 ~ EO 
Pl 
Pp3 


震 心 小 


图 9-3 Mvr3 指令 的 运动 轨迹 
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2. 指令 格式 

Mvr3 < 起 点 > ，,< 终 点 >,< 圆 心 点 > ”轨迹 类 型 , 插 补 类 型 ” 附 随 语句 

3. 术语 说 明 

(1) 起 点 : 圆 弧 起 点 。 

(2) 终点 : 圆 弧 终点 。 

(3) 圆心 点 : 圆心 。 

(4) 轨迹 类 型 : 常数 1 二 1, 绕 行 ; 常数 1 二 0, 捷 径 运 行 。 

(5) 插 补 类 型 : 常数 二 0, 关 节 插 补 ; 常数 二 1, 直 交 持 补 ; 常数 二 2, 通 过 特异 点 。 
4. 指令 例句 

1 Mvr3 Pl1,P2,P3' 一 一 以 P1,P2,P3 点 做 三 点 型 圆 弧 插 补 。 

2 Mvr3 P1,J2,P3' 一 一 以 P1,J2,P3 点 做 三 点 型 圆 弧 插 补 。 

3 Mvr3 P1,P2,P3 Wth M_Out(17) =1' 一 一 以 Pl,P2,P3 点 做 三 点 型 圆 弧 插 补 。 同 时 指令 输出 信号 
17 = ON。 


4 Mvr3 P3, (Plt 1,5),P4 WthIf M_In(20) = 1,M_Out(21) = 1 ' 一 一 以 B3，(Plt 1,5),P4 点 做 三 点 型 圆 
弧 插 补 , 同 时 如 果 输 入 信号 20 = ON 则 指令 输出 信号 21 = ON。 


9.4 M-V 编程 语言 


9.4.1 MELFA-BASIC V 的 详细 规格 


MELFA-BASIC V 是 三 菱 工 业 机 器 人 使 用 的 编程 语言 ,各 品牌 机 器 人 所 使 用 的 编程 语 
言 大 同 小 异 , 学 会 一 种 编程 语言 ,再 学 习 使 用 其 他 的 编程 语言 就 很 方便 了 。 在 学 习 使 用 
MELFA-BASIC V 之 前 ,需要 学 习 MELFA-BASIC V 的 相关 知识 。 

1. 程序 名 

“程序 名 ”只 可 以 使 用 英文 大 写字 母 及 数字 ,长 度 为 12 个 字母 。 如 果 要 使 用 “程序 选择 ” 
功能 时 , 则 必须 只 使 用 数字 作为 “程序 名 ”。 

2. 指令 

指令 由 以 下 部 分 构成 : 


1 Mov P1 Wth M_Out(17)=1 
OOG@ @| 


Q@ 步 序 号 或 称 为 “程序 行 号 ”。 

@ 指令 。 

@ 指令 执行 的 对 象 : 变量 或 数据 。 

@ 附 随 语句 。 

3. 变量 

编程 语言 中 对 指令 执行 的 对 象 使 用 了 大 量 的 变量 。 

1) 变量 大 分 类 

机 器 人 系统 中 使 用 的 变量 可 以 进行 大 分 类 ,如 图 9-4 所 示 。 

系统 变量 : 系统 变量 值 有 系统 反馈 的 ,表示 系统 工作 状态 的 变量 。 变 量 名 称 和 数据 类 


变量 


[| 系统 变量 
[二 | 系统 管理 变量 
一 | 用 户 管理 变量 


一 | 用户 自 定义 变量 


图 9-4 变量 大 分 类 

型 都 是 预先 规定 了 的 。 

系统 管理 变量 : 表示 系统 工作 状态 的 变量 ,在 自动 程序 中 只 用 于 表示 “系统 工作 状态 ”， 
例如 当前 位 置 P_CURR。 

用 户 管理 变量 : 是 系统 变量 的 一 种 ,但 是 用 户 可 以 对 其 处 理 , 例 如 输出 信号 M_OUT 
(18) 二 1。 用 户 在 自动 程序 中 可 以 指令 输出 信号 ON/OFF。 

用 户 自 定义 变量 : 这 类 变量 的 名 称 及 使 用 场合 由 用 户 自行 定义 ,是 使 用 最 多 的 变量 
类 型 。 

2) 用 户 变 量 的 分 类 

位 置 变量 : 表示 直 交 型 位 置 数 据 , 以 P 开 头 ,例如 Pl、P20。 

关节 型 变量 : 表示 关节 型 位 置 数据 (各 轴 的 旋转 角度 ) ,以 J 开头 ,例如 J、J10。 

数值 型 变量 : 表示 数值 ,以 M 开头 ,例如 MI1、M5(M1 一 0.345,M5 一 256) 。 

字符 串 变量 : 表示 字符 串 ,在 变量 名 后 加 $ ,例如 C1$ = “OPENDOOR”, 即 变量 C1$ 
表示 的 是 字符 串 *“OPENDOOR”。 

4. 程序 [正文 】 

构成 程序 的 最 小 单位 , 即 指令 及 数据 。 

Mov ”Pl 附 随 语句 

Mov 一 一 指令 。 

P1 一 一 数据 。 


1 Mov P1 WthM Out(17)=1 


Wth M_Out(17) 王 1 为 附 随 语 句 ,表示 在 移动 指令 的 同时 ,执行 输出 M_Out(17) 王 1。 

【程序 行 号 】 

编程 时 ,软件 自动 生成 “程序 行 号 "。 但 是 GOTO 指令 .GOSUb 指令 不 能 直接 指定 行 
号 ,否则 报警 。 

【标签 (指针 )】 

标签 是 程序 分 支 的 标记 ,用 * 十 英文 字母 构成 。 例 如 : 


GoTo * LBL 
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其 中 , * LBL 就 是 程序 分 支 的 标记 。 
9.4.2 有 特别 定义 的 文字 


1. 英文 大 小 写 

程序 名 指令 均 可 大 小 写 ,无 区 别 。 

2. 下 画 线 (_) 

下 画 线 标注 全 局 变量 。 全 局 变量 是 全 部 程序 都 可 以 使 用 的 变量 。 在 变量 的 第 二 个 字母 
位 置 用 下 画 线 表示 时 ,这 种 类 型 变量 即 为 全 局 变量 ,例如 P_Curr,M_01,M_ABC。 

3. 撒 号 (') 

撤 号 表示 后 面 的 文字 为 注释 。 例 如 : 


100 Mov P1'TORU 


其 中 ,TORU 就 是 注释 。 


4. 星 号 (x ) 

在 程序 分 支 处 做 标签 时 ,必须 在 第 一 位 加 星 号 (* ), 例 如 200 * KAKUNIN。 
5. 逗号 (,) 

逗号 用 于 分 隔 参 数 .变量 中 的 数据 ,例如 P1 一 (200, 150,…) 。 

6. 句号 (。) 


句号 用 于 标识 小 数位 置 变量 .关节 变量 中 的 成 分 数据 。 
例如 M1 王 P2.X 用 于 标识 P2 中 的 X 数 据 。 

7. 空格 

(1) 在 字符 串 及 注释 文字 中 ,空格 是 有 文字 意义 的 ; 
(2) 在 行 号 后 ,必须 有 空格 ; 

(3) 在 指令 后 ,必须 有 空格 ; 

(4) 数据 划分 ,必须 有 空格 。 

在 指令 格式 中 ,” ”表示 必须 有 空格 。 


9.4.3 数据 类 型 


1. 字符 串 常数 

用 双 引 号 括 起 来 的 文字 部 分 即 “ 字 符 串 常数 ”"。 例 如 "ABCDEFGHIJKLMN"、"123"。 

2. 位 置 数据 结构 

位 置 数 据 包括 坐标 轴 , 形 位 轴 , 附 加 轴 及 结构 标志 数据 ,如 图 9-5 所 示 。 

(1) X,Y,Z: 表示 机 器 人 “控制 点 "在 直角 坐标 系 中 的 坐标 。 

(2) A/B/C: 表示 以 机 器 人 “控制 点 ”为 基准 的 机 器 人 本 体 绕 XYZ 轴 旋 转 的 角度 , 称 为 
“ 形 位 ”。 

(3) L1/L2: 表示 附加 轴 运 行 数据 。 

(4) FL1: 构造 标志 ,表示 控制 点 与 特定 轴线 之 间 的 相对 关系 。 

(5) FL2: 构造 标志 ,表示 各 轴 的 旋转 角度 。 


(100 100 300 180 0 180 0 0) (70) 


一 一 一 一 一 构 洁 标 志 2( 多 圈 旋 转 数 据 ) 
构造 标志 1( 形 位 ) 
L2 轴 (附加 轴 2) 


L1 轴 (附加 轴 1) 
C 轴 


B 轴 


A 轴 
Z 轴 


Y 轴 


X 轴 


图 9-5 位 置 数据 结构 


9.5 需要 思考 的 问题 


(1) 两 点 型 圆 弧 插 补 指令 的 轨迹 通过 参考 点 吗 ? 
(2) Mvr3 指令 的 三 个 点 都 在 圆 弧 轨 迹 上 吗 ? 
(3) 什么 是 附 随 语句 ? 

(4) 什么 是 位 置 变量 和 数据 变量 ? 

(5) 什么 是 全 局 变量 ? 

(6) 位 置 数据 中 的 结构 标志 FL2 是 如 何 定 义 的 ? 


第 9 日 一 一 编程 指 令 欧 学 习 和 使 用 (1) 


击 心 溃 


第 10 章 第 10 日 一 一 编程 指令 的 学 习 和 使 用 (2) 


【学 习 目 的 】 

码 才 是 机 器 人 经 常 应 用 的 一 种 功能 ,机 器 人 编程 指令 中 有 专用 的 码 埃 指 令 。 本 章 将 
学 习 码 才 指 令 和 连续 轨迹 运行 指令 ,再 结合 第 21 章 的 学 习 , 可 以 对 码 埃 功 能 有 深入 的 
了 解 。 


10.1 码 翅 指令 


1. 功能 

PALLET 指令 也 翻译 为 “托盘 ?指令 “ 码 霹 ? 指 令 ,实际 上 是 一 个 计算 矩阵 方 格 中 各 ”点 
位 中 心 ”( 位 置 ) 的 指令 ,该 指令 需要 设置 矩阵 方 格 有 几 行 几 列 .起 点 终点 对 角 点 位 置 .计数 
方向 。 由 于 该 指令 通常 用 于 码 霹 动 作 , 所 以 也 就 被 称 为 “ 码 埃 ? 指 令 。 

2. 指令 格式 

Def Plt 一 一 定义 “托盘 结构 ?指令 (定义 一 个 矩阵 结构 ) 。 

Def Plt < 托盘 号 > < 起 点 > < 终点 A> < 终点 B> [< 对 角 点 >] < 列 数 A> < 行 数 B> < 托盘 类 

型 > 

Plt 一 一 指定 托盘 中 的 某 一 

3. 指令 样 例 1 

托盘 的 定义 及 类 型 1 如 图 10-1 所 示 。 


1 Def Plt 1,Pl,P2,P3， ,3,4,1' 一 一 3 点 型 托盘 定义 指令 
2 Def Plt 1,Pl,P2,P3,P4,3,4,1' 一 一 4 点 型 托盘 定义 指令 


(3 点 型 托盘 定义 指令 一 指令 中 只 给 出 起 点 ,终点 A ,终点 B; 

4 点 型 托盘 定义 指令 一 指令 中 给 出 起 点 、 终 点 A、 终 点 BB、 对 角 点 )。 
4. 说 明 

(1) 托盘 号 : 系统 可 设置 8 个 托盘 。 本 数据 设置 第 几 号 托盘 。 

(2) 起 点 /终点 /对 角 点 : 如 图 10-1 所 示 , 用 “位 置 点 ”设置 。 

(3) < 列 数 A >: 起 点 与 终点 A 之 间 的 列 数 。 

(4) < 行 数 B>: 起 点 与 终点 B 之 间 的 行 数 。 

(5) < 托盘 类 型 >: 设置 托盘 中 “各 位 置 点 ”分 布 类 型 。 


1=Z 字 型 2= 顺 排 型 3= 圆 弧 型 
11=Z 字 型 12= 顺 排 型 13= 圆 弧 型 


/ \ N 4 终点 
2 nloylo fn fw ~~5 
y 
7 |s [|e 7 8 5 
6 |s |4 4 |s [se 
1 |2 |3 1 |2 [3 
/ 起 点 a | 起 点 lk 
托盘 类 型 =1 2Z 字 型 托盘 类 型 =2 顺序 型 托盘 类 型 =3 圆 弧 型 


图 10-1 托盘 的 定义 及 类 型 1 


5. 指令 样 例 2 
托盘 的 定义 及 类 型 2 如 图 10-2 所 示 。 
(1) Def Plt 1,P1,P2,P3,P4,4,3,1’ 一 一 定义 1 号 托盘 。4 点 定义 。4 列 X3 行 。Z 字 


型 格式 。 
(2) Def Plt 2,P1,P2,P3,,8,5,2’ 一 一 定义 2 号 托盘 。3 点 定义 。8 列 X5 行 。 顺 排 型 
格式 (注意 3 点 型 指令 在 书写 时 在 终点 B 后 有 两 个 逗号 )。 


(3) Def Plt 3,P1,P2,P3,,5, 1,3’ 一 一 定义 3 号 托盘 。3 点 定义 。 圆 弧 型 格式 (注意 3 
点 型 指令 在 书写 时 在 终点 B 后 有 两 个 逗号 ) 。 

(4) (Plt 1,5) 一 一 1 号 托盘 第 5 点 。 

(5) (Plt 1,M1) 一 一 1 号 托盘 第 M1 点 (MI1 为 变量 ) 。 


P1 工件 位 置 
P4 终点 B 
ee 13 
5 行 | 10 
托盘 4 
1 
P2 起 点 / 三 列 \p3 终点 A 
托盘 类 型 =2 
图 10-2 托盘 的 定义 及 类 型 2 
6. 程序 样 例 1 
1 P3.A=P2.A' 一 一 设 定 " 形 位 "P3 点 A 轴 角 度 = P2 点 A 轴 和 角度 。 
2 P3.B=P2.B 一 一 设 定 P3 点 B 轴 角度 = P2 点 B 轴 角度 。 第 
3 B3.C= B2.C 一 一 设 定 P3 点 C 轴 角度 =P2 点 C 轴 角度 。 10 
4 P4.A=P2.A ' 一 一 设 定 P4 点 A 轴 角 度 =P2 点 A 轴 角 度 。 章 
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P4.B= P2.B ' 一 一 设 定 P4 点 B 轴 角度 =P2 点 B 轴 角度 。 
P4.C= P2.C 一 一 设 定 B4 点 C 轴 角度 = P2 点 C 轴 角度 。 
P5.A= P2.A 一 一 设 定 B5 点 A 轴 角 度 =P2 点 A 轴 角 度 。 
P5.B= P2.B 一 一 设 定 P5 点 B 轴 角度 = P2 点 B 轴 角度 。 
B5.C = P2.C 一 一 设 定 P5 点 C 轴 角度 = P2 点 C 轴 角度 。 


Def Plt 1, P2, P3,P4,P5,3,5,2' 一 一 设 定 1 号 托盘 ,3x 5 格 , 顺 排 型 。 
Ml1 = 1 一 一 设置 M1 变量 。 

* LOOP ' 一 一 循环 指令 LOOP。 

Mov P1, — 50' 前 进 到 Pl 点 近 点 。 

Ovrd 50 一 一 设置 速度 倍率 。 

Mvs P1 ' 一 一 前 进 到 Pl 点 。 

HClose 1° 1# 抓 手 闭合 。 

Dly 0.5 ' 一 一 暂停 。 

Ovrd 100 ' 一 一 设置 速度 倍率 。 


Mvs，- 50' 一 一 退回 到 Pl 点 近 点 。 

P10 = (Plt 1,M1) 一 一 ' 定 义 P10 点 为 1 号 托盘 “M1” 点 ,M1 为 变量 。 
Mov P10, - 50' 一 一 前 进 到 P10 点 近 点 。 

Ovrd 50 一 一 设置 速度 倍率 。 

Mvs P10 ' 一 一 运行 到 P10 点 。 

HOpen 1 ' 一 一 打开 抓 手 1。 

Dly 0.5 ' 一 一 暂停 。 

Ovrd 100 ' 一 一 设置 速度 倍率 。 

Mvs, - 50' 一 一 退回 到 P10 点 近 点 。 

M1= ML + 1' 一 一 M1 做 变量 运算 


29 If ML <= 15 Then * LOOP' 一 一 循环 指令 判断 条 件 。 如 果 Ml 小 于 等 于 15, 则 继续 循环 。 根 据 此 循环 
完成 对 托盘 1 所 有 "位 置 点 "的 动作 。 

30 End' 一 一 结束 。 

7. 程序 样 例 2 


形 位 在 土 180" 附 近 的 状态 。 


1 
2 


3 


4 


5 
6 


If Deg(P2.C)< 0 Then GoTo x MINUS' 一 一 如 果 P2 点 C 轴 角度 小 于 0 就 跳 转 到 Level MINUS 行 。 

If Deg(P3.C)<- 178 Then P3.C = P3.C+ Rad( + 360) ' 一 一 如 果 P3 点 C 轴 角 度 小 于 - 178* 就 指令 
P3 点 C 轴 +360"。 

If Deg(P4.C)<- 178 Then P4.C = P4.C+ Rad( + 360) ' 一 一 如 果 P4 点 C 轴 角 度 小 于 - 178" 就 指令 
P4 点 C 轴 +360"。 

If Deg(P5.C)<- 178 Then P5.C= P5.C+ Rad( + 360)' 一 一 如 果 P5 点 C 轴 角度 小 于 - 178" 就 指令 P5 
点 C 轴 +360"。 

GoTo x DEFINE ' 跳 转 到 Level DEFINE 行 。 

* MINUS' 一 一 程序 分 支 标志 。 

If Deg(P3.C)> + 178 Then P3.C =P3.C-Rad( + 360) 一 一 如 果 P3 点 C 轴 角度 大 于 178" 就 指令 P3 
点 C 轴 减 360 。 

If Deg(P4.C)> + 178 Then P4.C = P4.C- Rad( + 360) 一 一 如 果 P4 点 C 轴 角度 大 于 178" 就 指令 P4 
点 C 轴 减 360 。 

If Deg(P5.C)> +178 Then P5.C =P5.C- Rad( + 360) 一 一 如 果 P5 点 C 轴 角度 大 于 178" 就 指令 P5 
点 C 轴 减 360 。 

* DEFINE' 一 一 程序 分 支 标志 。 

Def Plt 1,P2,P3,P4,P5,3,5,2' 一 一 定义 1# 托 盘 。3x5 格 。 顺 排 型 。 


M1=1" M1 为 变量 。 
< LOOP' 一 一 循环 指令 标志 。 
Mov P1, -50' 一 一 前 进 到 P1 点 近 点 。 


15 Ovrd 50 一 一 设置 速度 倍率 。 
16 Mvs P1' 一 一 前 进 到 Pl 点 。 
17 HClose 1' 一 一 1 号 抓 手 闭合 。 


18 Dly 0. 5' 一 一 暂停 。 


19 Ovrd 100 ' 一 一 设置 速度 倍率 。 
后 退 到 Pl 点 近 点 。 


20 Mvs, - 50' 


21 P10= (Plt 1??M1) 一 一 定义 P10 点 (为 1 号 托盘 中 的 M1 点 。M1 为 变量 ) 。 


22 Mov P10, — 50°" 


24 Mvs P10 * 


26 Dly 0.5 一 一 暂停 。 


27 Ovrd 100 一 一 设置 速度 倍率 。 


前 进 到 P10 点 近 点 。 
23 Ovrd 50' 一 一 设置 速度 倍率 。 

前 进 到 P10 点 。 

25 HOpen 1 一 一 打开 抓 手 1。 


28 Mvs，- 50 ' 一 一 后 退 到 P10 点 近 点 。 


29 ML = ML + 1 ,一 一 变量 M1 运算 。 


30 If ML<= 15 Then x LOOP' 一 一 循环 判断 条 件 , 如 果 Ml 小 于 等 于 15, 则 继续 循环 。 执 行 15 个 点 的 抓 


取 动作 。 
31 End' 一 一 结束 。 


10.2 连续 轨迹 运行 指令 CNT 


1. 功能 


连续 轨迹 运行 是 指 机 器 人 控制 点 在 运行 通过 各 位 置 点 时 ,不 做 每 一 点 的 加 减速 运行 ,而 


是 以 一 条 连续 的 轨迹 通过 各 点 ,如 图 10-3 所 示 。 


连续 动作 模式 
Pl P2 


动作 开始 位 置 


50 


通过 P1,P2 附 近 ， 往 P3 移 动 


P2 P3 
\ 
\ 


进度 | 
GG 


时 间 
连续 轨迹 运行 时 的 速度 曲线 


图 10-3 连续 轨迹 运行 时 的 运行 轨迹 和 速度 曲线 


2. 指令 格式 


Cnt <1/0>[,< 数 值 1>][,< 数 值 2>] 


说 明 : 


<1/0>: Cnt 1 一 一 连续 轨迹 运行 。 


Cnt 0 一 一 连续 轨迹 运行 无 效 。 
< 数值 1 >: 过 渡 圆 弧 尺 寸 1。 
< 数值 2 >: 过 渡 圆 弧 尺 寸 2。 


在 连续 轨迹 运行 通过 某 一 位 置 点 时 ,其 轨迹 不 实际 通过 位 置 点 ,而 是 一 个 过 渡 圆 弧 ,这 


个 过 渡 圆 弧 轨 迹 由 指定 的 数值 构成 。 


3. 程序 样 例 


1 Cnt 0 一 一 连续 轨迹 运行 无 效 。 


第 10 日 一 一 编 午 指令 的 学 习 和 使 用 (2) 


30 日 学 凤 工 业 胡 器 人 


2 Mvs P1' 一 一 移动 到 Pl 点 。 

3 Cnt 1 ' 一 一 连续 轨迹 运行 有 效 。 

4 Mvs P2' 一 一 移动 到 P2 点 

5 Cnt 1,100,200' 一 一 指定 过 渡 圆 弧 数据 100mm/200mm。 
6 Mvs P3' 一 一 移动 到 P3 点 。 

7 Cnt 1,300' 指定 过 渡 圆 弧 数据 300mm/300mm。 

8 


Mov P4' 一 一 移动 到 P4 点。 

9 Cnt 0 ' 一 一 连续 轨迹 运行 无 效 。 

10 Mov P5' 一 一 移动 到 P5 点 。 

4. 说 明 

(1) 从 Cntl 到 Cnt0 的 区 间 为 连续 轨迹 运行 有 效 区 间 。 

(2) 系统 初始 值 为 Cnt0( 连 续 轨迹 运行 无 效 ) 。 

(3) 如 果 省 略 “ 数 值 1”“ 数 值 2 的 设置 ,其 过 渡 圆 弧 轨迹 如 图 10-4 中 虚线 所 示 , 圆 弧 起 
始点 为 "减速 开始 点 ”, 圆 弧 结 束 点 为 “加速 结束 点 ”。 


MB.MC 值 不 相同 
时 ， 取 较 小 值 连接 


MB,MC 值 不 相同 
时 ， 取 较 小 值 连 接 


1 Cntl 


2 MOVPI p3 
3 Cntl,MC.MB 
4 MOVP2 
1 Cnt 1 
5 MOVP3 
2 MOVPI 
减速 起 始 位 置 3 MOVP2 6 canto 
4 MOV P3 指定 接近 距离 ， 按 
5 Cnt 0 箭头 所 示 轨 迹 运行 
未 指定 接近 距离 。 


按 箭头 所 示 轨 迹 
运行 


图 10-4 连续 运行 轨迹 及 过 渡 尺 十 


10.3 需要 思考 的 问题 


(1) 码 埃 指 令 的 实质 是 什么 ? 

(2) 3 点 型 码 埃 指令 与 4 点 型 码 埃 指令 有 何 区 别 ? 
(3) 托盘 上 各 点 的 分 布 有 几 种 方式 ? 

(4) 如 何 连续 执行 对 托盘 上 各 点 的 定位 ? 

(5) 连续 轨迹 指令 的 运行 轨迹 是 否 通过 各 位 置 点 ? 
(6) 连续 轨迹 指令 的 运行 是 否 会 出 现 反 复 加 减速 ? 


1] 音 第 11 日 一 一 机 器 人 的 “控制 点 "及 
| “位 置 点 ”数据 运算 


a 


【学 习 目 的 】 
在 第 3 章 的 学 习 中 ,已 经 让 机 器 人 动 了 起 来 。 在 第 6 章 的 学 习 中 ,已 经 让 机 器 人 按 简单 
so 但 是 我 们 只 看 到 机 器 人 的 运行 ,》 de EE 人 
-点 。 如 果 要 求 机 器 人 到 达 某 一 位 置 点 ,是 要 求 机 器 人 的 某 一 个 部 位 "点 ”到 达 
过 本 童 的 学 将 习 要 明确 这 些 问题 。 


11.1 机 器 人 的 “控制 点 ” 


对 初学 者 而 言 , 机 器 械 人 的 “控制 点 "在 哪里 ,这 是 一 个 既 明 白 又 糊涂 的 问题 。 因 为 用 示 
教 单元 操作 时 ,可 以 看 见 机 器 人 在 运行 ,但 对 精确 定位 时 是 要 求 机 器 人 的 哪 一 个 部 位 到 达 指 
定位 置 又 有 些 糊涂 。 实 际 上 ,“ 机 器 人 控制 点 ”是 指 “ 和 人 上 的 一 个 点 ,在 出 厂 时 ,这 
个 点 被 定义 为 机 器 人 “法 兰 中 心 点 ” ,就 是 机 械 IE 的 中 心 点 ,如 图 11-1 和 图 11-2 所 示 。 


机 械 IF 


默认 的 TOOL 坐 > 
标 系 Xt、Yt、 Zt 上 | 全 
际 ， - 
XxXw 
默认 的 机 械 坐 标 系 
Xw、Yw、Zw 
图 11-1 控制 点 在 机 械 法 兰 中 心 图 11-2 控制 点 在 机 械 IF 坐标 系 原点 


如 果 设 置 了 TOOL 坐标 系 后 (TOOL 坐标 系 即 工具 坐标 系 , 大 多 数 时候 也 即 抓 手 坐标 
系 , 抓 手 就 连接 在 法 兰 上 ),“ 机 器 人 控制 点 ”就 是 TOOL 坐标 系 的 原点 ,如 图 11-3 所 示 , 所 
以 在 JOG 动作 和 自动 程序 中 ,是 指令 这 一 “机 器 人 控制 点 ”移动 到 指定 的 位 置 。 


30 日 学 凤 工 业 胡 器 人 


= 
95mm 1 
XtYt 
Zt 


有 4 
图 11-3 控制 点 在 TOOL 坐标 系 原点 


11.2 ”如何 表 示 一 个 “位 置 点 ” 


“位 置 点 "如何 表示 呢 ? 确定 * 位 置 点 "需要 以 下 数据 。 
1. 坐标 位 置 和 旋转 角度 位 置 
如 图 11-4 和 图 11-5 所 示 ,“ 位 置 点 ”由 以 下 几 个 数据 构成 。 


(100 100 300 180 0 180 0 0) (7,0) 


一 一 一 一 构造 标志 2( 多 圈 旋 转 数据 ) 
构造 标志 1( 形 位 ) 
L2 轴 (附加 轴 2) 


L1 轴 (附加 轴 1) 
C 轴 


B 轴 
A 轴 
Z 轴 
Y 轴 
X 轴 


图 11-4 表示 “位 置 点 ”的 8 个 数据 


(1) X,Y,Z 一 一 表示 “机 器 人 控制 点 ”在 直角 坐标 系 中 的 坐标 。 

(2) A,B,C 一 一 表示 绕 XYZ 轴 旋 转 的 角度 (就 一 个 “点 ”位 而 言 , 没 有 旋转 的 概念 ,所 以 
旋转 是 指 以 该 “位 置 点 ?为 基准 ,以 抓 手 为 刚体 , 绕 世 界 坐标 系 的 XYZ 轴 旋 转 。 这 样 即使 是 
同一 个 “位 置 点 ”, 抓 手 的 形 位 也 有 N 种 变化 ) 。 
注意 : X,Y,Z 和 A,B.,C 全 部 以 世界 坐标 系 为 基准 。 

(3) L1,L2 一 一 附加 轴 ( 僻 服 轴 ) 定 位 位 置 。 

(4) FL1 一 一 构造 标志 (上 下 左右 高 低位 置 ) 。 

(5) FL2 一 一 各 关节 轴 旋 转 度数 。 

2. 结构 标志 

(1) FL1 一 一 结构 标志 (上 下 左右 高 低位 置 )。 用 一 组 二 进 制 数 表示 ,“ 上 下 左右 高 低 ” 
用 不 同 的 bit 表示 ,如 图 11-5 所 示 。 


7=&B00000111( 二 进 制 ) 


1/0=NOn Flip/ Flip 高 低 
1/0=Above/Below 上 下 


1/0=RightLeft 左 右 
图 11-5 表示 FL1 一 一 结构 标志 的 二 进 制 数 


(2) FL2 一 一 各 关节 轴 旋 转 度数 。 用 一 组 十 六 进 制 数 表示 ,如 图 11-6 所 示 。 


0=&H00000000( 十 六 进 制 ) 


6 轴 ( 最 常 被 使 用 ) 

7 轴 

8 轴 

11-6 表示 FL2 一 一 各 关节 轴 旋 转 度数 的 十 六 进 制 数 


11.3 ”结构 标志 FL1 


“位 置 点 ”是 由 X,Y,Z,A,B,C(FL1,FL2) 标 记 的 。 由 于 机 器 人 结构 的 特殊 性 ,即使 是 
同一 “位 置 点 ”, 机 器 人 也 可 能 出 现 不 同 的 * 形 位 *”。 为 了 区 别 这 些 “ 形 位 ”, 采 用 了 结构 标志 。 
用 位 置 标记 的 (X,Y,Z,A,B,C) (FL1,FL2) 中 的 “FL1” 标 记 。 


11.3.1 重 直 多 关节 型 机 器 人 

1. 左右 标志 

(1) 5 轴 机 器 人 : 以 用 轴 旋 转 中心 线 为 基准 ,判别 第 5 轴 法 兰 中 心 点 了 P 位 于 “该 中 心 
线 ?” 的 左面 还 是 右面 。 如 果 在 右边 , 则 FL1 bit2=1; 如 果 在 左边 , 则 FL1 bit2 二 0; 如 图 11-7 
所 示 。 


5 轴 机 器 人 6 轴 机 器 人 
图 11-7 左右 判定 


三 沽 


击 


第 11 日 一 一 机 器 人 的 “控制 点 ”及 “位 置 点 ” 洛 据 运算 


30 日 学 嵌 工 业 胡 器 人 


(2) 6 轴 机 器 人 : 以 用 轴 旋 转 中 心 线 为 基准 ,判别 J5 轴 
中 心 点 P 位 于 该 中 心 线 的 左面 还 是 右面 。 如果 在 右边 , 则 
FL1 bit2 二 1; 如 果 在 左边 , 则 FL1 bit2 二 0; 如 图 11-8 所 示 。 


1 
RIGHT 一 ~ LEFT 


注意 : FL1 标志 信号 用 一 组 二 进 制 码 表示 ,检验 左右 位 Pp SN 
置 用 bit2 表示 。 | A) 
2. 上 下 判断 > 


(1) 5 轴 机 器 人 : 以 J2 轴 旋 转 中 心 和 J3 轴 旋 转 中 心 的 mi 人 小 、 
连接 线 为 基准 ,判别 J5 轴 中 心 点 了 是 位 于 该 中 心 连接 线 的 上 ”“ 施 转 中 心 _ 了 P| 了 7 
面 还 是 下 面 。 如 果 在 上 面 , 则 FL1 bitl = 1; 如 果 在 下 面 , 则 人 
FL1 bitl 一 0; 如 图 11-9 所 示 。 图 11-8 FL1 标志 的 左右 判断 
(2) 6 轴 机 器 人 : 以 J2 轴 旋 转 中 心 和 了 J3 轴 旋 转 中 心 的 
连接 线 为 基准 ,判别 J5 轴 中 心 点 P 是 位 于 该 中 心 连接 线 的 上 面 还 是 下 面 。 如 果 在 上 面 , 则 
FL1 bitl 二 1; 如 果 在 下 面 , 则 FL1 bitl 王 0; 如 图 11-10 所 示 。 


BELOW 
> 号 得 
旋转 中 心 


卫 轴 
旋转 中 心 


BELOW 


ABOVE 


5 轴 机 器 人 6 轴 机 器 人 
11-9 FL1 标志 中 上 下 的 判定 


注意 : FL1 标志 信号 用 一 组 二 进 制 码 表示 ,检验 上 下 位 置 用 bitl 表示 。 

3. 高 低 判断 

第 6 轴 法 兰 面 (6 轴 机 型 ) 方 位 判断 。 以 J4 轴 旋 转 中 心 和 J5 轴 旋 转 中 心 的 连接 线 为 基 
准 ,判别 6 轴 的 法 兰 面 是 位 于 该 中 心 连接 线 的 上 面 还 是 下 面 。 如 果 在 下 面 , 则 FL1 bit0 一 1， 
如 果 在 上 面 , 则 FL1 bit0==0; 如 图 11-11 所 示 。 


NON FLI 


图 11-10 FL1 标志 中 上 下 的 判定 及 显示 图 11-11 J6 轴 法 兰 面 位 置 的 判定 


注意 : FL1 标志 信号 用 一 组 二 进 制 码 表示 ,检验 高 低位 置 用 bit0 表示 。 


11.3.2 水 平 运动 型 机 器 人 


以 JI 轴 旋 转 中 心 和 了 J2 轴 旋 转 中心 的 连接 线 为 基准 ,判别 机 器 人 前 端 位 置 控 制 点 是 位 
于 该 中 心 连接 线 的 左面 还 是 右面 。 如 果 在 右面 , 则 FL1 bit2 王 1; 如 果 在 左面 , 则 FL1 bit2 一 0; 
如 图 11-12 所 示 。 


i 


图 11-12 水 平 运动 型 机 器 人 的 FL1 标志 


11.4 ”结构 标志 FL2 


FL2 标志 为 各 关节 轴 旋 转 度数 ,用 一 组 十 六 进 制 数 表示 ,如 图 11-13 所 示 。 


0=&H00000000( 十 六 进 制 ) 


6 轴 ( 最 常 被 使 用 ) 
7 轴 
8 轴 


图 11-13 表示 FL2 各 关节 轴 旋 转 度数 的 十 六 进 制 数 
各 轴 的 旋转 角度 与 数值 之 间 的 关系 如 图 11-14 所 示 。 


以 J6 轴 为 例 : 

旋转 角度 一 一 180" 一 0 一 180” FL2 王 H00000000 第 

旋转 角度 王 180" 一 540” FL2 王 H00100000 11 
章 


第 11 日 一 机 器 人 的 “ 扔 制 点 ”及 “位置 点 "数据 运算 


30 日 学 烧 工 业 机 器 人 


旋转 角度 一 540" 一 900” FL2 王 H00200000 
旋转 角度 王 -180" 一 -540? FL2 王 HOOF00000 
旋转 角度 一 -540" 一 -900” FL2= HOOE00000 
各 |-900~ -540~ —180~ |0~ 180~ 540~ 
轴 |-540 —180 0 180 |540 900 
角 
度 
FL2| -2(E) -1l(F) 0 0 T 2 
数 
据 


图 11-14 旋转 度数 与 十 六 进 制 数 的 关系 


11.5 位 置 点 的 计算 方法 


11.5.1 位 置 点 采 法 运算 
位 置 数据 乘法 运算 表达 式 如 下 ， 
P100= Pl * P2 


位 置 数据 的 乘法 运算 实际 是 变换 到 TOOL 坐标 系 的 以 P1 点 为 基准 的 TOOL 坐 标 系 
过 程 。 在 下 例 中 ,“P100 二 Pl x P2”,P1 点 是 在 世界 坐标 系 
中 确定 的 点 。 又 将 P1 点 作为 TOOL 坐标 系 中 的 原点 ,P2 
是 TOOL 坐标 系 中 的 坐标 点 ,如 图 11-15 所 示 。 注 意 P1、 
P2 点 的 排列 顺序 ,顺序 不 同 ,意义 也 不 一 样 。 

乘法 运算 就 是 在 TOOL 坐标 系 中 的 “加 法 运算 ”, 除 
法 运算 就 是 在 TOOL 坐标 系 中 的 “减法 运算 >”。 由 于 乘法 
运算 经 常 使 用 在 “根据 当前 点 位 置 计算 下 一 点 的 位 置 ”所 
以 特别 重要 ,使 用 者 需要 仔细 体会 。 

程序 样 例 : 


P1= (200,150,100,0,0,45)(4,0) ' 一 一 Pl 点 数值 。 
P2= (10,5,0,0,0,0)(0,0) 一 一 P2 点 数值 。 
P100 = Pl * P2' 一 一 Pl 与 P2 的 乘法 运算 。 

Mov P1' 一 一 前 进 到 Pl 点 。 

Mvs P100 ' 一 一 直线 前 进 到 P100 点 。 


图 11-15 位 置 数据 运算 一 一 乘法 


性 


11.5.2 位 置 数 据 的 加 法 /减法 
位 置 数据 的 加 法 运算 表达 式 如 下 : 
P100 = P1 + P2 


加 法 运算 是 以 机 器 人 世界 坐标 系 为 基准 .以 Pl 为 起 点 ,P2 点 为 坐标 值 进行 的 加 法 运算 


(减法 运算 可 以 理解 为 以 P] 为 起 点 ,P2 点 为 坐标 值 进 
行 的 减法 运算 ) ,如 图 11-16 所 示 。 
样 例 : 


1 B1 = (200,150,100,0,0,45)(4,0) 一 一 Pl 点 数值 。 
2 P2=(5,10,0,0,0,0)(0,0)" P2 点 数值 。 

3 P100=Pl+P2" P1 与 P2 的 加 法 运算 。 

4 ”Mov Pl 一 一 前 进 到 Pl 点 。 

5 Mvs P100 ' 一 一 直线 前 进 到 P100 点 。 


因此 从 本 质 上 来 说 ,位 置 数据 的 乘法 与 加 法 的 区 别 
在 于 各 自 依据 的 坐标 系 不 同 , 但 都 是 以 第 1 点 为 基准 ， 
第 2 点 作为 绝对 值 增 量 进行 运算 。 


机 器 人 坐标 系 
11-16 位置 数据 运算 一 一 加 法 


11.6 需要 思考 的 问题 


(1) 机 器 人 控制 点 在 机 器 人 的 哪个 部 位 ? 
(2) 确定 一 个 “位 置 点 "需要 几 个 数据 ? 


(3) 只 用 直角 坐标 是 否 能 够 完整 表示 机 器 人 的 “ 形 位 ”? 


(4) 结构 标志 FL1 表示 什么 内 容 ? 
(5) 结构 标志 FL2 表示 什么 内 容 ? 
(6) 如 何 进 行 位 置 点 的 乘法 运算 ? 
(7) 如 何 进 行 位 置 点 的 除法 运算 ? 
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第 11 日 一 一 机 器 人 的 “控制 点 ”及 “位 置 点 ” 洛 据 运算 


第 12 章 第 12 日 一 一 编程 指令 的 学 习 和 使 用 (3) 


【学 习 目 的 】 

: 章 进行 编程 指令 的 深度 学 习 , 学 习 程序 结构 方面 的 指令 。 实 际 上 ,任何 一 个 实用 的 程 
序 都 不 会 是 简单 的 顺序 结构 ,而 是 一 个 复杂 的 程序 结构 ,因此 在 面 对 一 个 工程 项 目 时 ,应 该 
是 先 构 建 程序 结构 , 青 进行 各 分 支 程 序 的 编程 ,这 是 学 习 者 应 该 牢记 的 。 


12.1 无 条 件 跳 转 指 令 


GoTo 无 条 件 跳 转 : 只 要 程序 运行 到 GoTo, 就 无 条 件 地 执行 跳 转 。GoTo 必须 指定 跳 
转 的 目标 位 置 。 


12.2 判断 -选择 指令 


1. 功能 

本 指令 是 根据 “条 件 ” 执 行 “程序 分 支 跳 转 ”的 指令 ,是 改变 程序 流程 的 基本 指令 。 

2. 指令 格式 1 

If < 判断 条 件 式 > Then < 流程 1 > [Else < 流程 2>] 

这 种 指令 格式 是 在 程序 一 行 里 书写 的 判断 -执行 语句 。 如 果 条 件 成 立 就 执行 Then 后 
面 的 程序 指令 ; 如 果 条 件 不 成 立 则 执行 Else 后 面 的 程序 指令 。 

3. 指令 例句 1 

1 If ML > 10 Then * L100' 一 一 如 果 ML 大 于 10, 则 跳 转 到 * L100 行 。 

2 If ML > 10 Then GoTo * L20 Else GoTo * L30' 如 果 ML 大 于 10, 则 跳 转 到 * L20 行 , 否 则 跳 转 到 

*I30 行 。 

4. 指令 格式 2 

如 果 判 断 一 跳 转 指令 的 处 理 内 容 较 多 ,无 法 在 一 行程 序 里 表示 ,就 使 用 指令 格式 2。 


于 < 判断 条 件 式 > 
Then 

< 流程 1 > 

Else 

< 流程 2> 

EndIf 


如 果 条 件 成 立 则 执行 Then 后 面 一 直到 Else 的 程序 行 ; 如 果 条 件 不 成 立 则 执行 Else 
后 面 到 EndIf 的 程序 行 。EndIf 用 于 表示 流程 2 的 程序 结束 。 
5. 指令 例句 2 
If M1 > 10 Then ' 一 一 如 果 M1 大 于 10, 则 
M1 = 10 ' 一 一 赋值 


1 

2 

3 Mov Pl1" 前 进 到 Pl 点 
4 Else' 否则 
和 

6 

7 


M1 =- 10 ' 一 一 赋值 
Mov P2， 前 进 到 P2 点 
EndIf ' 一 一 本 指令 结束 


6. 指令 例句 2 
多 级 If…Then*…Else…EndIf 在 套 : 


If M1 > 10 Then' 一 一 (第 1 级 判断 - 执行 语句 ) 
If M2 > 20 Then' 一 一 (第 2 级 判断 - 执行 语句 ) 
M1 = 10' 一 一 赋值 

M2 = 10' 一 一 赋值 

Else' 否则 

M1 = 0' 一 一 赋值 

M2 = 0' 一 一 赋值 

EndIf 一 一 (第 2 级 判断 - 执行 语句 结束 ) 
Else' 一 一 否则 

10 M1 =- 10' 一 一 赋值 

11 M2 =- 10' 一 一 赋值 

12 EndIf' 一 一 (第 1 级 判断 -执行 语句 结束 ) 


7. 指令 例句 3 
在 对 Then 及 Else 的 流程 处 理 中 ,以 Break 指令 跳 转 到 EndIf 的 下 一 行 。 从 If*…Then*… 
EndIf 的 流程 中 跳 转 出 来 (不 要 使 用 GoTo 指令 跳 转 ) 。 


Dowaoumewhb 


1 If ML > 10 Then' 一 一 (第 1 级 判断 - 执行 语句 ) 

2 If M2 > 20 Then Break' 一 一 如 果 M2 > 20 就 跳 转 出 本 级 判断 执行 语句 (本 例 中 为 10 行 ) 
3 M1 = 10' 一 一 赋值 

4 M2 = 10' 一 一 赋值 

5 Else' 一 一 否则 

6 Ml =- 10' 一 一 赋值 

7 If M2 > 20 Then Break' 一 一 如 果 M2 > 20 就 跳 转 出 本 级 判断 执行 语句 (本 例 中 为 10 行 ) 
8 M2 =- 10' 一 一 赋值 

9 EndIf ' 一 一 结束 判断 指令 

10 If M BrkCq=1 Then HIt 

11 Mov P1 ' 一 一 前 进 到 P1 点 


8. 说 明 
(1) 多 行 型 指令 IT…Then…Else…EndIf 必须 书写 EndIf, 不 得 省 略 ,否则 无 法 确定 “ 流 
程 2” 的 结束 位 置 。 
(2) 不 要 使 用 GoTo 指令 跳 转 到 本 指令 之 外 。 
(3) 嵌 套 多 级 指令 最 多 为 8 级。 章 
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30 日 学 左 工 业 胡 器 人 
(4) 在 对 Then 及 Else 的 流程 处 理 中 ,以 Break 指令 跳 转 到 EndIf 的 下 一 行 。 
12.3 选择 指令 Select Case 


1. 功能 
本 指令 用 于 根据 不 同 的 条 件 选择 执行 不 同 的 程序 块 。 指 令 流 程 参看 图 12-1 。 


Select Case 


果 不 符合 任 一 条 件 同时 
也 没 


Default 语 句 


程序 步 
1 
break 
1 程序 步 
default 1 
如 果 以 上 条 件 都 不 满足 re 
T reak 
程序 步 
1 
break 
1 
| End Select 
i 
程序 语句 
12-1 Select Case 语句 的 执行 流程 
2. 指令 格式 
Select < 条 件 > 
Case < 计算 式 > 
[< 处 理 >] 
Break 
Case < 计算 式 > 
[< 处 理 >] 
Break 
Default 
[< 处 理 >] 
Break 


End Select 


< 条 件 > 一 一 数值 表达 式 。 


3. 指令 例句 

1 Select MCNT 

2 Ml=10 

3 Case Is<= 10' 一 一 如 果 MCNT<10 

4 Mov P1' 前 进 到 Pl 点 

5 ”Break' 一 一 跳 转 到 程序 结束 

6 Case 11 ' 一 一 如 果 MCNT = 11 OR MCNT = 12 
7 Case12 

8 Mov P2" 前 进 到 P2 点 

9 ”Break' 一 一 跳 转 到 程序 结束 


10 Case 13 To 18' 一 一 如 果 13<MCN<18 

11 Mov P4' 一 一 前 进 到 P4 点 

12 Break' 一 一 跳 转 到 程序 结束 

13 Default' 一 一 除 上 述 条 件 以 外 

14 M_Out(10) = 1' 一 一 赋值 

15 Break ' 一 一 跳 转 到 程序 结束 

16 End Select' 一 一 选择 语句 结束 

4. 说 明 

(1) 如 果 “ 条 件 ” 的 数据 与 某 个 case 的 数据 一 致 , 则 执行 到 Break 行 然后 跳 转 到 End 
Select 行 。 

(2) 如 果 条 件 都 不 符合 ,就 执行 Default 规定 的 程序 。 

(3) 如 果 没 有 Default 指令 规定 的 程序 ,就 跳 到 End Select 的 下 一 行 。 


12.4 选择 指令 On GoTo 


1. 功能 

本 指令 是 根据 不 同 条 件 跳 转 到 不 同 程序 分 支 处 的 指令 。 判 断 条 件 是 计算 式 ,可 能 有 不 
同 的 计算 结果 ,根据 不 同 的 计算 结果 跳 转 到 不 同 程序 分 支 处 。 本 指令 与 On GoSub 指令 的 
区 别 是 : On GoSub 是 跳 转 到 子 程序 ,On GoTo 指令 是 跳 转 到 某 一 程序 行 。 

指令 流程 参看 图 12-2。 

2. 指令 格式 


on < 条 件 计算 式 > GoTo < 程序 行 标签 1 >< 程 序 行 标签 2> 
3. 指令 例句 


On M1 GoTo * ABC1, * LJMP, x LM1_345, x LM1 345, *LM1 345, *L67, *L67 
一 一 如 果 ML = 1, 就 跳 转 到 * ABC1 行 。 
如 果 ML = 2, 就 跳 转 到 * IIMP 行 。 
如 果 ML = 3,Ml1 = 4,Ml1 = 5, 就 跳 转 到 * ILM1_345 行 。 
如 果 Ma =6,M1 = 7, 就 跳 转 到 * L167 行 。 
11 MOV P500 * M1 不 等 于 1 一 7 就 跳 转 到 本 行 。 
100 * ABC1 ' 一 一 程序 分 支 标志 
101 MOV P100 一 一 前 进 到 P100 点 。 


第 12 日 一 一 篇 程 指 会 的 学 习 和 使 用 (3) 


30 日 学 烧 工 业 胡 器 人 


110 MOV P200 ， 
111 x LJMP' 一 一 程序 分 支 标志 


前 进 到 P200 点 。 


112 MOV P300 * 


前 进 到 P300 点 。 


i 

170 x*167' 一 一 程序 分 支 标志 

171 MOV P600 ' 前 进 到 P300 点 。 
172" .…… 


200 * LM1_345' 一 一 程序 分 支 标志 
201 MOV P400 * 前 进 到 P300 点 。 


202" ce. 
ON<<M1>GOTO.. 
各 程序 分 支 
程序 分 支 1 
程序 分 支 2 
程序 分 支 3 
程序 语句 
12-2 ”ON…GoTo 指令 的 流程 
12.5 子 程序 指令 GoSub 
1. 功能 


本 指令 为 调用 子 程序 指令 。 子 程序 前 有 * 标志 。 在 子 程序 中 必须 要 有 返回 指令 
Return。 这 种 调用 方法 与 CallP 指令 的 区 别 是 : GoSub 指令 指定 的 “ 子 程序 ” 写 在 “同一 程 
序 ” 内 ,用 “标签 ”标定 “起 始 行 ”, 以 Return 作为 子 程序 结束 并 返回 “ 主 程序 ”; 而 CALLP 指 
令 调 用 的 程序 可 以 是 一 个 独立 的 程序 。 

2. 指令 格式 

GoSub < 子 程序 标签 > 

3. 指令 例句 


10 GoSub * LBL 


11 End 


100 * LBL 
101 Mov P1 
102 Return ' 一 一 务必 写 Return 指令 


4. 说 明 
(1) 子 程序 结束 务必 写 Return 指令 ,不 能 使 用 GoTo 指令 。 
(2) 在 子 程序 中 还 可 使 用 GoSub 指令 ,可 以 使 用 800 段 。 


12.6 子 程 序 调用 指令 CallP 


1. 功能 
本 指令 用 于 调用 子 程序 。 
2. 指令 格式 及 说 明 


CallP [程序 名 ][ 自 变量 1][ 自 变量 2] 


(1) 程序 名 一 一 被 调用 的 子 程序 名 字 。 

(2) [ 自 变量 1]\[ 自 变量 3] 一 一 设置 在 子 程序 中 使 用 的 变量 ,类似 于 局 部 变量 ,只 在 被 
调用 的 子 程序 中 有 效 。 

3. 指令 例句 1 

调用 子 程序 时 同时 指定 自 变 量 。 
1 ML=0 
2 CallP "10" ,M1,P1,P2' 一 一 调用 "10" 号 子 程序 ,同时 指定 ML,P1,P2 为 子 程序 中 使 用 的 变量 。 
3 Ml=1 
4 CallP "10" ,M1,Pl,P2' 一 一 调用 "10" 号 子 程序 ,同时 指定 M1, Pl1,P2 为 子 程序 中 使 用 的 变量 。 


10 CallP "10"，M2,P3,P4' 一 一 调用 "10" 号 子 程序 ,同时 指定 M2,P3, P4 为 子 程序 中 使 用 的 变量 。 
15 End 


“10” 子 程序 : 


FPrm M01，P01, P02' 一 一 规定 与 主 程序 中 对 应 的 "变量 " 
If M01 <> 0 Then GoTo * LBL1' 一 一 判断 语句 
Mov P01' 一 一 前 进 到 P01 点 
* LBL1 ' 一 一 程序 分 支 标志 
Mvs P02' 一 一 前 进 到 P02 点 
End' 一 一 结束 (返回 主 程序 ) 


注意 : 在 主 程序 第 1 步 .第 4 步调 用 子 程 序 
时 ,“10” 子 程序 变量 M01， P01., P02 与 主 程序 指 
定 的 变量 M1,P1l1,P2 相对 应 。 

在 主 程序 第 10 步调 用 子 程序 时 ,“10” 子 程序 
变量 M01, P01, P02 与 主 程序 指定 的 变量 M2， 
P3,P4 相对 应 。 12 

主 程序 与 子 程序 的 关系 如 图 12-3 所 示 。 Sd 章 
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第 12 日 一 一 编程 指令 的 学 习 和 使 用 (3) 


30 日 学 烧 工 业 夫 器 人 


4. 指令 例句 2 
调用 子 程序 时 不 指定 自 变量 : 


Mov P1" 


1 前 进 到 Pl 点 

2 ”CallP "20" ' 一 一 调用 "20" 号 子 程序 
3 Mov P2' 一 一 前 进 到 Pl 点 
4 

5 


CallP "20"' 一 一 调用 "20" 号 子 程序 
End 


“20” 子 程序 : 


1 MovPl ----—-— ' 子 程序 中 的 P1 与 主 程序 中 的 P1 不 同 
2 Mvs P002" 前 进 到 P002 点 

3 M_out(17) =1' 一 一 赋值 

4 End 一 一 结束 


5. 说 明 

(1) 子 程序 以 END 结束 并 返回 主 程序 。 如 果 没 有 END 指令 , 则 在 最 终 行 返回 主 程序 。 

(2) CallP 指令 指定 自 变 量 时 ,在 子 程序 一 侧 必须 用 FPrm 定义 自 变量 ,而 且 数 量 类 型 
必须 相同 ,否则 发 生 报警 。 

(3) 可 以 执行 8 级 子 程序 调用 。 

(4) TOOL 数据 在 子 程序 中 有 效 。 


12.7 FPrm 


1. 功能 

从 主 程序 中 调用 子 程序 指令 时 ,如 果 规 定 有 自 变量 ,就 用 本 指令 使 主 程序 定义 的 “局 部 
变量 ?在 子 程序 中 有 效 。 

2. 指令 格式 


FPrm < 假设 自 变量 >< 假 设 自 变量 > 


3. 指令 例句 
主 程序 了 


1 ML = 1' 一 一 赋值 

2 P2=P_Curr' 一 一 设置 P2 为 当前 点 

3”P3=P100' 一 一 赋值 

4 ”CallP "100", M1, P2,P3' 一 一 调用 子 程序 "100"， 同时 指定 了 变量 ML1，P2,P3 


子 程序 “100”: 


FPrm M1, P2, P3' 一 一 指令 从 主 程序 中 定义 的 变量 有 效 
If M1 = 1 Then GoTo * LBL' 一 一 判断 执行 语句 

Mov P1 ' 一 一 前 进 到 P1 点 

* LBL' 一 一 程序 分 支 标志 

Mvs P2' 一 一 前 进 到 P2 点 

End' 一 一 程序 结束 
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12.8 子 程序 调用 指令 On GoSub 


1. 功能 
根据 不 同 的 条 件 调用 不 同 的 子 程序 ,指令 流程 参看 图 12-4。 


ON<M1>GoSub 


第 1 子 程序 
return 


第 2 子 程序 


return 


第 3 子 程序 
return 


图 12-4 ON…GoSub 指令 的 流程 
2. 格式 
On < 式 > GoSub[< 子 程序 标记 > ] [，[< 子 程序 标记 >] ] 


3. 术语 

< 式 > 一 一 数值 运算 式 (作为 判断 条 件 ) 。 

< 子 程序 标记 > 一 一 记述 子 程序 标记 名 ,最 大 数 为 32。 
4. 指令 样 例 

根据 M1 数值 (1 一 7) 调 用 不 同 的 子 程序 。 


(M1 = 1 时 调用 子 程序 ABC1, M1 = 2 时 调用 子 程序 Lsub、M1 = 3、4、5 时 调用 子 程序 LM1_345,ML =6、7 
时 调用 子 程序 L57) 

1 M1 = M_Inb(16) And gH7' 一 一 赋值 

2 On ML GoSub * ABC1, * Lsub, * LMI 345, * LM1_345, * LMI_345, * L167, * 167' 一 一 子 程序 调用 指 
令 ( 注 意 , 有 7 个子 程序 ) 

100 x ABC1' 一 一 子 程序 标志 

101 一 一 M1 = 1 时 的 程序 处 理 

102 Return' 一 一 务必 以 Return 返回 主 程序 

121 * Lsub' 一 一 子 程序 标志 

122 ' 一 一 M1 = 2 时 的 程序 处 理 

123 Return' 一 一 务必 以 Return 返回 主 程序 

170 *167' 一 一 子 程序 标志 

171 ' 一 一 ML = 6,M1=7 时 的 程序 处 理 
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172 Return' 务必 以 Return 返回 主 程序 

200 x IM1_345 一 一 子 程序 标志 

201 'ML =3\ML=4ML=5 时 的 子 程序 

202 Return' 务必 以 Return 返回 主 程序 

5. 说 明 

(1) 以 < 数值 运算 式 > 的 值 决 定 调用 某 个 子 程序 。 

例如 ,< 数值 运算 式 > 的 值 =2, 即 调用 第 2 号 记述 的 子 程序 。 

(2) < 数值 运算 式 > 的 值 大 于 < 调用 子 程序 > 个 数 时 ,就 跳 转 到 下 一 行 。 例 如 ,< 数值 运算 
式 > 的 值 王 5,< 调 用 子 程序 > 一 3 的 情况 下 ,会 跳 转 到 下 一 行 。 

(3) 子 程序 结束 处 必须 写 Return, 以 返回 主 程序 。 


12.9 需要 思考 的 问题 


(1) 什么 是 程序 结构 ? 

(2) If…Then…Else…EndIf 指令 在 什么 地 方 结束 ? 中 间 可 以 有 和 多少 层 ? 
(3) GoSub 指令 与 CallP 指令 有 什么 不 同 ? 

(4) 对 于 不 同 的 条 件 选择 不 同 的 子 程序 可 以 使 用 什么 指令 ? 

(5) 对 于 不 同 的 条 件 选择 不 同 的 程序 分 支 可 以 使 用 什么 指令 ? 

(6) Return 指令 起 什么 作用 ? 
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【学 习 目的 】 
本 章 继续 进行 编程 指令 的 深度 学 习 , 本 章 学 习 的 循环 指令 .中断 指令 也 是 属于 程序 结构 
方面 的 指令 。 


13.1 循环 指令 


1. 功能 
本 指令 为 循环 动作 指令 。 如 果 满 足 循环 条 件 , 则 循环 执行 While… Wend 之 间 的 动作 ; 
如 果 不 满足 循环 条 件 则 跳出 循环 。 


2。 指令 格式 


While < 循环 条 件 > 


处 理 动作 
WEnd 


< 循环 条 件 > 一 数据 表达 式 ” 
时 序 步 

3. 指令 例句 ee 

- 4 人 和 

= 5 , 出 ， 

如 果 M1 为 一 5 和 5, 则 循环 执行 ,程序 如 下 。 循环 条 件 处 理 
1 While (M1 >=- 5) And (M1 < = 5) ' 一 一 如 果 ML 为 -5 和 5 
则 循环 执行 End 
2 M1=- (ML + 1) ' 一 一 循环 条 件 处 理 
3 M_out(8) = ML ' 一 一 赋值 程序 语句 
4 WEnd' 一 循环 结束 指令 
ey 图 13-1 循环 语句 流程 


本 指令 的 循环 过 程 如 图 13-1 所 示 。 
13.2 中 断 


13.2.1 Def Act 中 疡 指令 


1. 功能 
本 指令 用 于 定义 执行 中 断 程序 的 条 件 及 中 断 程 序 的 动作 。 
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2. 指令 格式 及 说 明 
Def Act < 中 断 程序 级 别 >< 条 件 >< 执 行动 作 >< 类 型 > 


(1) < 中 断 程 序 级 别 > 一 一 设置 中 断 程序 的 级 别 ( 中 断 程 序号 ) 。 

(2) < 条 件 > 一 一 是 否 执 行 * 中 断 程序 ”的 判断 条 件 。 

(3) < 执行 动作 > 一 一 中 断 程 序 动作 内 容 。 

(4) < 类 型 > 一 一 中 断 程序 的 执行 时 间 点 ,也 就 是 主 程序 的 停止 类 型 。 
@ 省 略 : 停止 类 型 1, 以 100% 速 度 售 率 正常 停止 。 

@ S: 停 止 类 型 2, 以 最 短 时 间 、 最 短 距离 减速 停止 。 

@@ 工 :停止 类 型 3 ,执行 完 当 前 程序 行 后 才 停止 。 

3. 指令 例句 


1 Def Act 1,M_In(17) = 1 GoSub * L100' 一 一 定义 Act 1 中 断 程 序 为 : 如 果 输 入 信号 17 = ON, 则 跳 转 
到 子 程序 * L100。 

2 Def Act 2, MFG1 And MFG2 GoTo * L200' 一 一 定义 Act 2 中 断 程 序 : 如 果 MFG1 与 MFG2 的 "逻辑 AND" 
运算 = 真 , 则 跳 转 到 子 程序 * L200。 

3 Def Act 3,M_Timer(1)> 10500 GoSub * LBL' 一 一 定义 Act 3 中 断 程序 为 : 如 果 计 时 器 时 间 大 于 
10500ms 则 跳 转 到 子 程序 * LBL。 

10 x*L100:M_Timer(1) = 0' 一 一 计时 器 M_Timer(1) 设 置 =0。 

11 Act 3=1' 一 一 Act 3 动作 区 间 有 效 。 

12 Return 0' 一 一 返回 。 


20 * L200' 一 一 程序 分 支 标志 。 
21 Mov P_Safe' 一 一 前 进 到 安全 点 。 
22 End' 一 一 结束 。 


30 * LBL' 一 一 程序 分 支 标志 。 

31 M_Timer(1) = 0' 一 一 计时 器 M_Timer(1) 设 置 =0。 

32 Act 3=0' 一 一 Act 3 动作 区 间 无 效 。 

32 Return 0' 一 一 返回 。 

4. 说 明 

(1) 中 断 程 序 从 * 跳 转 起 始 行 ?到 Return 结束 ; 

(2) 中 断 程序 级 别 以 号 码 1 一 8 表示 ,数字 越 小 越 优先 ,如 Act 1 优先 于 Act 2; 
(3) 执行 中 断 程序 时 , 主 程序 的 停止 类 型 如 图 13-2 和 图 13-3 所 示 。 


停止 类 型 | 外 部 速度 比例 100% 外 部 速度 比例 50% 
速度 


S1=S2 


人 信 上 而 亢 ) 
| 72 


时 间 
图 13-2 停止 类 型 1 一 一 停止 过 程 中 的 行程 相同 


外 部 速度 比例 100% 外 部 速度 比例 50% 


停止 | 速度 
类 型 2 | + (是 信号 
时 间 
执行 完 进攻 
成 停止 
ZY 
ZU 敌 
时 间 时 间 


图 13-3 停止 类 型 2 一 一 以 最 短 时 间 ,最 短 距 离 减速 停止 


13.2.2 Act 指令 


1. 功能 

ACT 指令 有 以 下 两 重 意义 。 

ACT 1 一 ACT 8 是 “中 断 程序 ”的 程序 级 别 标志 。 

ACT n= 二 1,ACT n=0 划 出 了 中 断 程序 ACT n 的 生效 区 间 。 
2. 指令 格式 


ACT ”< 被 定义 的 程序 级 别 标志 >=<1> 一 一 中 断 程序 可 执行 区 间 起 始 标志 
ACT ”< 被 定义 的 程序 级 别 标志 >=<0> 一 一 中 断 程序 可 执行 区 间 结 束 标志 


指令 格式 说 明 : 
< 被 定义 的 程序 级 别 标志 > 一 一 设置 中 断 程序 的 “程序 级 别 标志 ”。 
3. 指令 例句 1 


1 Def Act 1,M_In(1) = 1 GoSub x INTR' 一 一 定义 Act 1 对 应 的 "中 断 程序 "。 
2 MovP1' 前 进 到 Pl 点 。 

3 Act1=1' 一 一 "Act 1 定义 的 中 断 程序 "动作 区 间 生 效 。 

4 ”Mov P2' 一 一 前 进 到 P2 点 。 

5 Act1=0' 一 一 "Act 1 定义 的 中 断 程序 "动作 区 间 无 效 。 

6 

半 

8 


* INTR' 一 一 程序 分 支 标志 
If M_In(1) = 1 GoTo x INTR' 一 一 判断 执行 语句 
Return 0 ' 一 一 返回 


4. 指令 例句 2 

1 Def Act 1,M_In(1) = 1 GoSub x INTR' 一 一 定义 Act 1 对 应 的 "中 断 程序 " 

2 Mov Bl1' 前 进 到 P1 点 。 

3 Act 1=1' 一 一 Act 1 动作 区 间 生 效 第 
4 Mov P2' 一 一 前 进 到 P2 点 。 13 
5 x INTR' 一 一 程序 分 支 标志 章 
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6 act 1 = 0' 一 一 act 1 动作 区 间 无 效 


7 M_out(10) =1 一 一 赋值 
Return 1 ' 一 一 结束 
5. 说 明 
(1) Act 0 为 最 优先 状态 。 程 序 启动 时 即 为 "Act 0 二 1” 状 态 。 如 果 “Act 0 二 0”, 则 “Act 
1 一 8 一 1? 也 无 效 。 


(2) 中 断 程 序 的 结束 (返回 ) 由 “Return 1? 或 “Return 0 指定。 
Return 1 一 一 转 入 主 程序 的 下 一 行 ; 
Return 0 一 一 跳 转 到 主 程序 中 “中 断 程序 ”的 发 生 行 。 


13.3 暂停 指令 HLT 


1. 功能 

本 指令 为 暂停 执行 程序 ,程序 处 于 待机 状态 。 如 果 发 出 再 启动 信号 ,从 程序 的 下 一 行 启 
本 指令 在 分 段 调试 程序 时 常用 。 

2. 指令 格式 

Ht 

3. 指令 例句 1 

1 Hlt' 一 一 无 条 件 暂停 执行 程序 。 


4. 指令 例句 2 

满足 某 一 条 件 时 ,执行 暂停 。 

100 If M_In(18) = 1 Then Ht' 一 一 如 果 输入 信号 18 = ON, 则 暂停 。 

200 Mov Pl WthIf M_In(17) =1, Hlt ' 一 一 在 向 Pl 点 移动 过 程 中 ,如 果 输 入 信号 17 = ON 则 暂停 。 
5. 说 明 

(1) 在 Hlt 暂停 后 ,重新 发 出 启动 信号 ,程序 从 下 一 行 启动 执行 。 

(2) 如 果 是 在 附 随 语句 中 发 生 的 暂停 ,重新 发 出 启动 信号 后 ,程序 从 中 断 处 启动 执行 。 


和 


13.4 暂停 指令 DLY 


1. 功能 

本 指令 用 于 设置 程序 中 的 “暂停 时 间 ”, 也 作为 构成 “脉冲 型 输出 ”的 方法 。 
2. 指令 格式 

(1) 程序 暂停 型 

Dly < 暂停 时 间 > 


(2) 设 定 输出 信号 二 ON 的 时 间 ( 构 成 脉冲 输出 ) 


M_Out(1) = 1 Dly< 时 间 > 


3. 指令 例句 1 

1 Dly 30 ' 一 一 程序 暂停 时 间 30s。 

4. 指令 例句 2 

设 定 输出 信号 二 ON 的 时 间 ( 构 成 脉冲 输出 ) : 


1 M_out(17) = 1 D1Y 0.5' 一 一 输出 端子 (17) = ON 时 间 为 0.5s 
2 M_outb(18) = 1 D1Y 0.5' 一 一 输出 端子 (18) = ON 时 间 为 0.5s 


13.5 需要 思考 的 问题 


(1) 循环 指令 也 是 改变 程序 结构 的 指令 吗 ? 

(2) 如 何 制作 循环 指令 的 循环 条 件 ? 

(3) 中 断 指令 主要 用 于 什么 场合 ? 

(4) 中 断 指令 分 级 吗 ? 

(5) 如 何 定义 中 断 指令 的 有 效 工 作 区 间 ? 如 果 在 有 效 工 作 区 间 之 外 , 某 中 断 指令 的 条 
件 满足 ,程序 会 如 何 运 行 ? 

(6) 中 断 指令 执行 完毕 后 会 返回 主 程序 吗 ? 

(7) DLY 指令 与 HLT 指令 有 什么 区 别 ? 在 需要 暂时 停止 执行 程序 时 用 哪 一 种 指令 ? 
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第 14 章 第 14 日 一 一 状态 变量 的 学 习 和 使 用 


【学 习 目 的 】 

机 器 人 的 工作 状态 如 * 当 前 位 置 ?等 是 可 以 用 变量 的 形式 表示 的 。 实 际 上 ,每 一 种 工业 
控制 器 都 有 表示 自身 工作 状态 的 功能 ,如 数控 系统 用 “X 接口 ?表示 工作 状态 ,所 以 机 器 人 的 
状态 变量 就 是 表示 机 器 人 的 “工作 状态 ”的 数据 ,在 实际 应 用 中 极为 重要 。 本 章 将 详细 解释 
各 机 器 人 状态 变量 的 定义 、 功 能 和 使 用 方法 。 


14.1 常用 状态 变量 P_Curr 当前 位 置 
(X,Y,Z,A,B,C,L1,L2)(CFLI,FL2) 


1. 功能 
P_Curr 为 “当前 位 置 *, 这 是 最 常用 的 变量 。 
2. 格式 


< 位 置 变量 > = P_Curr < 机 器 人 编号 > 
< 位 置 变量 > 一 一 以 开头 ,表示 "位 置 点 "的 变量 
< 机 器 人 编号 > 一 1 一 3, 省 略 时 为 1 


3. 例句 


1 Def Act 1,M_In(10) = 1 GoTo * LRCT' 一 一 定义 一 个 中 断 程序 。 
2 Act 1=1' 一 一 中 断 区 间 有 效 。 

3 ”Mov Pl1' 一 一 前 进 到 Pl 点 。 

4 ”Mov P2' 一 一 前 进 到 P2 点 。 

5 Act 1=0' 一 一 中 断 区 间 无 效 。 

100 * LRCT' 程序 分 支 标志 。 


101 P100=P_Curr' 读 取 当 前 位 置 。 设 置 P100 = 当前 位 置 。 
102 Mov P100, - 100' 一 一 移动 到 P100 近 点 -100 的 位 置 。 


103 End' 结束 。 
14.2 P Fbc 以 伺服 反馈 脉冲 表示 的 当前 位 置 
(X,Y,Z,A,B,C,L]1,L2)(FLI1 ,FL2) 
1. 功能 


P_Fbc 是 以 伺服 反馈 脉冲 表示 的 当前 位 置 (X,Y,Z,A,B,C,L1,L2)(FL1,FL2)。 


2. 格式 


< 位 置 变量 > = P_Fbc < 机 器 人 编号 > 
< 机 器 人 编号 > 一 一 1 一 3, 省 略 时 为 1 


3. 例句 


1 Pl=P_Fbc' 一 一 Pl 点 为 以 脉冲 表示 的 当前 位 置 。 


14.3 常用 状态 变量 J_Curr 各 关节 轴 的 
当前 位 置 数据 
1. 功能 
J Curr 是 以 各 关节 轴 的 旋转 角度 表示 的 “当前 位 置 "数据 ,在 编写 程序 时 是 经 常 使 用 的 
要 数据 。 
2. 格式 


< 关节 型 变量 > = J_Curr < 机 器 人 编号 > 


< 关节 型 变量 >: 注意 要 使 用 “关节 型 的 位 置 变量 ”一 一 以 J 开头 。 
< 机 器 人 编号 >: 设置 范围 1 一 3。 
3. 例句 


J1=J_Curr' 一 一 设置 有 1 为 关节 型 当前 位 置 点 


14.4 J_ECurr 当前 编码 器 脉冲 数 
1. 功能 
J_ECurr 为 各 轴 编 码 器 发 出 的 “脉冲 数 ”。 
2. 格式 


< 关节 型 变量 >= J_ECurr < 机 器 人 编号 >< 关 节 型 变量 > 一 一 注意 要 使 用 "关节 型 的 位 置 变量 ", 以 了 
开头 。 
< 机 器 人 编号 > 一 一 设置 范围 1 一 3。 


3. 例句 


1 JA=J_ECurr(1)' 一 一 设置 JA 为 各 轴 脉 冲 值 
2 MA=JA.Jl' 设置 MA 为 J1 轴 脉冲 值 


14.5 常用 状态 变量 J_Fbc/J_AmpFbec 关节 轴 的 


当前 位 置 /关节 轴 的 当前 电流 值 


1. 功能 
(1) J_Fbc 一 一 以 编码 器 实际 反馈 脉冲 表示 的 关节 轴 当 前 位 置 。 
(2) J AmpFbc 一 一 关节 轴 的 当前 电流 值 。 
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2. 格式 


(1) < 关节 型 变量 > = J_Fbc < 机 器 人 编号 > 
(2) < 关节 型 变量 > = J_AmpFbc < 机 器 人 编号 > 


< 关节 型 变量 >: 注意 要 使 用 “关节 型 的 位 置 变量 ”, 以 J 开头 。 
< 机 器 人 编号 >: 设置 范围 1 一 3。 
3. 例句 


1 J1=J_Fbc' 一 一 J1 = 以 编码 器 实际 反馈 脉冲 表示 的 关节 轴 当 前 位 置 。 
2 J2=J_AmpFbc' 一 一 J2 = 各 轴 当 前 电流 值 。 


14.6 M In/M Inb/M_In8/M_Inw/M_In16 
一 一 输入 信号 状态 


1. 功能 

这 是 一 类 输入 信号 状态 ,是 最 常用 的 状态 信号 。 

M_In 一 一 位 信号。 

M_Inb/M_In8 一 一 以 “ 字 节 ”为 单位 的 输入 信号 。 

M_Inw/M_In16 一 一 以 “ 字 ” 为 单位 的 输入 信和 号。 

2. 格式 

(1) < 数值 变量 > = M_In < 数 式 > 

(2) < 数值 变量 > = M_Inb < 数 式 > 或 M_In8 < 数 式 > 

(3) < 数值 变量 > = M_Inw < 数 式 > 或 M_ In16 < 数 式 > 

3. 说 明 

< 数 式 > 一 一 输入 信号 地 址 。 输 入 信号 地 址 的 分 配 定义 如 下 。 

(1) 0 一 255: 通用 输入 信和 号。 

(2) 716 一 731: 多 抓 手 信 号 。 

(3) 900 一 907: 抓 手 输入 信号 。 

(4) 2000 一 5071: PROFIBUS 用 。 

(5) 6000 一 8047: CC-Link 用 。 

4. 例句 
M1% =M_In(10010) 一 一 ML = 输入 信号 10010 的 值 (1 或 0)。 
M2% =M_Inb(900)' 一 一 M2 = 输入 信号 900 一 907 的 8 位 数值 。 


1 
交 

3 M3% =M_Inb(10300) And &H7' 一 一 M3 = 10300 一 10307 与 HT 的 逻辑 和 运算 值 。 

4 Mg =M Inw(15000)' 一 一 M4= 输 入 15000~15015 构成 的 数据 值 (相当 于 一 个 16 位 的 数据 寄存 器 ) 。 


14.7 M_OuMM_Outb/M_Out8/M_Outw/M_Onut16 
一 一 输出 信号 状态 


1. 功能 
输出 信号 状态 。 


(1) M_Out 一 一 以 “位 ”为 单位 的 输出 信号 状态 。 
(2) M_Outb/M_Out8 一 一 以 “ 字 节 (8 位 )” 为 单位 的 输出 信和 号 数据 。 
(3) M_Outw/M_Out16 一 一 以 “ 字 (16 位 )” 为 单位 的 输出 信号 数据 。 
这 是 最 常用 的 变量 之 一 。 
2. 格式 
(1) M_Out(< 数 式 1>) = < 数值 2> 
(2) M_Outb(< 数 式 1>) 或 M_0ut8(< 数 式 1>) =< 数 值 3> 
(3) M_Outw(< 数 式 1 >) 或 M_ Out16(< 数 式 1>) = < 数值 4> 
(4) M_Out(< 数 式 1>) = < 数值 2> dly < 时 间 > 
< 数值 变量 > = M_Out(< 数 式 1 >) 
3. 说 明 
< 数 式 1 > 一 一 用 于 指定 输出 信号 的 地 址 。 输 出 信号 的 地 址 分 配 如 下 。 
(1) 10000 一 18191: 多 CPU 共用 软 元 件 。 
(2) 0 一 255: 外 部 MO 信和 号。 
(3) 716 一 723: 多 抓 手 信 号 。 
(4) 900 一 907: 抓 手 信号 。 
(5) 2000 一 5071: PROFIBUS 用 信和 号。 
(6) 6000 一 8047: CC-Link 用 信号 。 
(7) < 数值 2 >,< 数 值 3 >,< 数 值 4 >: 输出 信号 输出 值 ,可 以 是 常数 .变量 ,数值 表达 式 。 
(8) < 数值 2 > 设置 范围 : 0 或 1。 
(9) < 数值 3 > 设置 范围 : 一 128 一 十 127。 
(10) < 数值 4 > 设置 范围 : 一 32 768 十 32 767。 
(11) < 时 间 >: 设置 输出 信号 =ON 的 时 间 。 单 位 : 秒 。 
4. 例句 
M_Out(902) = 1 ' 一 一 指令 输出 信号 902 = ON。 
M_Outb(10016) = &HFF ' 一 一 指令 输出 信号 10016 一 10023 的 8 位 = ON。 
M Outw(10032) = &HFFFF ' 指令 输出 信号 10032 一 10047 的 16 位 = ON。 
M4 =M Outb(10200) And &HOF' M4 = (输出 信号 10200 一 10207) 与 HOF 的 逻辑 和 。 
5. 说 明 
输出 信号 与 其 他 状态 变量 不 同 。 输 出 信号 是 可 以 对 其 进行 “指令 ”的 变量 而 不 仅仅 是 
“ 读 取 其 状态 ”的 变量 。 实 际 上 更 多 的 是 对 输出 信号 进行 设置 ,指令 输出 信号 二 ON/OFF。 


14.8 需要 思考 的 问题 


(1) 为 什么 要 了 解 机 器 人 的 工作 状态 ? 
(2) 什么 是 机 器 人 的 “当前 位 置 "? 机 器 人 的 “当前 位 置 " 有 几 种 表示 方法 ? 

(3) 输入 信号 有 几 种 表示 方式 ? 

(4) 输出 信号 有 几 种 表示 方式 ? 

(5) 输出 信号 仅仅 是 只 读 信号 吗 ? 

(6) 输入 输出 的 地 址 分 配 有 什么 意义 ? 14 
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第 14 日 一 一 状态 变量 的 学 习 和 使 用 


第 15 章 第 15 日 一 一 机 器 人 系统 的 特殊 功能 


【学 习 目 的 】 

机 器 人 不 同 于 一 般 的 运动 机 械 , 机 器 人 具备 多 轴 (6 轴 ) 联 动 功能 ,其 应 用 范围 也 有 其 特 
殊 性 ,所 以 机 器 人 有 许多 其 他 运动 机 械 所 没有 的 功能 ,本 章 将 对 这 些 特 殊 功 能 进行 介绍 ,以 
便 读者 在 实际 应 用 时 使 用 这 些 功能 。 


15.1 操 作 权 


1. 能 够 对 机 器 人 进行 控制 的 设备 

对 机 器 人 进行 控制 的 设备 有 以 下 几 种 。 

(1) 示 教 单元 ; 

(2) 操作 面板 (外 部 信号); 

(3) 计算 机 ; 

(4) 触摸 屏 。 

某 一 类 设备 对 “机 器 人 ”的 控制 权 就 称 为 “操作 权 ”。 示 教 单元 上 有 一 个 “使 能 开关 ”就 是 
“操作 权 ” 开 关 。 如 表 15-1 所 示 是 示 教 单元 上 的 “使 能 开关 ”与 “操作 权 ” 的 关系 。 

表 15-1 示 教 单元 上 的 “使 能 开关 ”与 “操作 权 ” 的 关系 


使 能 开关 无 效 有 效 
设 定 开关 
控制 器 自动 手动 自动 手动 
示 教 单元 NO NO NO YES 
控制 器 操作 面板 YES NO NO NO 
让 计算 机 YES NO NO NO 
外 部 信号 YES NO NO NO 


YES 一 一 有 操作 权 ,NO 一 一 无 操作 权 。 


2. 与 操作 权 相 关 的 参数 

IOENA 一 一 本 信号 的 功能 是 使 外 部 操作 信号 有 效 和 无 效 。 在 RT TooLBox2 软件 中 的 
“参数 ”一 “通用 1” 中 设置 本 参数 。 

操作 权 : 对 机 器 人 的 操作 可 能 来 自 中 示 教 单元 ; @ 外 部 信号 ; @ 计 算 机 软件 (调试 时 ); 
四 触摸 屏 。 
3. 实际 操作 
实际 操作 如 下 。 


(1) 在 示 教 单元 中 ENABLE 开关 二 ON, 可 以 进行 示 教 操作 。 即 使 外 部 IO 操作 权 王 
ON, 即 使 外 部 没有 选择 “自动 模式 ”, 也 可 以 通过 示 教 单元 的 “开机 ”一 “运行 >“ 操作 ”面板 
一 “启动 进行 程序 “启动 ”>( 示 教 单元 有 优先 功能 ENABLE)。 

(2) 如 果 在 操作 面板 上 选择 了 “自动 模式 ”, 而 ENABLE 一 ON, 系统 会 报警 ,使 
ENABLE 二 OFF ,报警 消除 。 

(3) 如 果 需 要 进入 调试 状态 .必须 使 IOENA 二 OFF。 

(4) 如 果 使 用 外 部 信号 操作 , 则 需要 使 IOENA 二 ON。 


15.2 其 他 功能 


1. 最 佳 速度 控制 

最 佳 速度 控制 功能 是 指 机 器 人 在 两 点 之 间 运 动 , 需 要 在 保持 形 位 要 求 的 同时 ,还 需要 控 
制 速度 ,防止 速度 过 大 出 现 报警 。 

最 佳 速度 控制 功能 有 效 时 ,机 器 人 控制 点 速度 不 固定 。 用 Spd M_NSpd 指令 可 设置 
“最 佳 速度 控制 ”。 

2. 最 佳 加 减速 度 控制 

最 佳 加 减速 度 控制 是 指 机 器 人 根据 加 减速 时 间 、 抓 手 及 工件 重量 、 工 件 重心 位 置 ,自动 
设置 最 佳 加 减速 时 间 的 功能 。 

用 Oadl(Optimal Acceleration) 指 令 设 置 最 佳 加 减速 度 控制 。 

3. 柔性 控制 功能 

柔性 控制 功能 是 指 对 机 器 人 的 综合 力度 进行 控制 的 功能 。 通 常用 于 压 嵌 工件 的 动作 。 
(以 直角 坐标 系 为 基础 ) 根 据 伺 服 编码 器 反馈 脉冲 ,进行 机 器 人 柔性 控制 。 用 Cmp Too 指令 
设置 “伺服 柔性 控制 功能 ”。 

4. 碰撞 检测 功能 

碰撞 检测 功能 是 指 在 自动 运行 和 JOG 运行 中 ,系统 时 刻 检测 TOOL 或 机 械 臂 与 周边 
设备 的 碰撞 干涉 状态 。 用 ColChk (Col Check) 指 令 设置 “碰撞 检测 功能 "的 有 效 / 无 效 。 

机 器 人 配置 有 对 “碰撞 而 产生 的 异常 "进行 检测 的 “碰撞 检测 功能 ”, 出 厂 时 将 “碰撞 检测 
功能 ”设置 为 无 效 状态 。 “碰撞 检 测 功 能 ”的 有 效 / 无 效 状态 切换 可 通过 参数 COL 及 ColChk 
指令 完成 ,必须 作为 对 机 器 人 及 外 围 装 置 的 保护 加 以 运用 。 

“碰撞 检测 功能 "是 通过 机 器 人 的 动力 学 模型 ,在 随时 推算 动作 所 需 的 扭矩 的 同时 ,对 异 
常 现象 进行 检测 的 功能 。 因 此 , 当 抓 手 、 工 件 条 件 的 设置 (参数 : HNNDDAT x* WRKDAT x* 
的 设置 值 ) 与 实际 相差 过 大 时 ,或 是 速度 .电机 扭矩 有 急剧 变动 的 动作 (特殊 点 附近 的 直线 动 
作 或 反 转 动作 ,低温 状态 或 长 期 停止 后 启动 运行 ) ,急剧 的 扭矩 变动 就 会 被 检测 为 “碰撞 ”。 
简单 地 说 ,就 是 一 直 检测 “计算 转 矩 与 实际 转 矩 的 差 值 ”, 当 该 值 过 大 时 ,就 报警 。 

5. 连续 轨迹 控制 功能 

在 多 点 连续 定位 时 ,使 运动 轨迹 为 一 连续 轨迹 。 本 功能 可 以 避免 多 次 的 分 段 加 减速 从 
而 提高 效率 。 用 Cnt(Continuous) 指 令 设置 “连续 轨迹 控制 功能 ”。 

6. 附加 轴 控 制 

控制 行走 台 等 外 部 伺服 驱动 系统 。 外 部 伺服 轴 相 对 于 机 器 人 而 言 即 为 “附加 轴 ”。 


种 15 日 一 一 故 器 人 系统 的 兰 殊 功能 


击 吕 恰 


30 日 学 典 工 业 帮 器 人 


7. 多 机 器 控制 

可 控制 多 台 机 器 人 。 

8. 与 外 部 机 器 通信 功能 

机 器 人 与 外 部 机 器 通信 功能 有 下 列 方法 。 

(1) 通过 外 部 1/O 信号: 

CR750Q 一 一 PLC 通信 ,输入 8192/ 输 出 8192。 

CR750D 一 一 输入 256/ 输 出 256 。 

(2) 与 外 部 数据 的 链 路 通信 。 

所 谓 数据 链 路 指 与 外 部 机 器 (视觉 传感器 等 ) 收 发 补偿 量 等 数据 ,通过 “以 太 网 端口 ” 
进行 。 

9. 人 码 埃 指 令 功能 

机 器 人 配置 有 码 埃 指 令 , 有 多 行 . 单 行 . 圆 弧 码 抬 指令 。 实 际 上 是 确定 矩阵 点 格 中 心 点 
位 置 的 指令 。 

10. 用 户 定义 区 

用 户 可 设置 32 个 任意 空间 ,监视 机 器 人 前 端 控制 点 是 否 进入 该 区 域 ,将 机 器 人 状态 输 
出 到 外 部 并 报警 。 

可 以 用 下 列 三 种 方法 限制 机 器 人 动作 范围 。 

(1) 关节 轴 动 作 范 围 限制 (J1 一 J6) 。 

(2) 以 直角 坐标 系 设置 限制 范围 。 

(3) 以 任意 设置 的 平面 为 界面 设置 限制 范围 (在 平面 的 前 面 或 后 面 ), 由 参数 SFCnAT 
设置 。 


15.3 需要 思考 的 问题 


(1) 什么 是 操作 权 ? 

(2) 什么 是 碰撞 检测 功能 ? 
(3) 什么 是 柔性 控制 功能 ? 
(4) 什么 是 最 佳 速度 控制 功能 ? 


第 16 章 


【学 习 目 的 】 


第 16 日 一 一 参数 的 功能 及 设置 (1) 


参数 用 于 表示 机 器 人 的 不 同 工 作 性 能 。 设 置 不 同 的 参数 可 以 给 机 器 人 赋予 不 同 的 性 
能 。 本 章 要 学 习 机 器 人 的 动作 型 参数 和 程序 型 参数 。 


16.1 动作 型 参数 


16.1.1 动作 型 参数 一 览 表 
动作 型 参数 一 览 表 如 表 16-1 所 示 。 
表 16-1 动作 型 参数 一 览 表 
序号 | 参数 类 型 | 参数 符号 参数 名 称 参数 功能 

1 | 动作 |MEJAR | 动作 范围 用 于 设置 各 关节 轴 旋 转 范围 
2 | 动作 |MEPAR ”| 各 轴 在 直角 坐标 系 行程 范围 ese 
3 | 动作 [Useprog | 用 户 设置 的 原点 用 户 自行 设置 的 原点 
4 | 动作 |MELTEXS | 机 械 手 前 端 行程 限制 用 于 限制 机 械 手 前 端 对 基 座 的 干涉 

- 是 设置 关节 轴 的 JOG 的 步 进行 程 和 
5 | 动作 ”|JOGJSP “|JOG 步 进行 程 和 速度 倍率 

本 - 设置 以 直角 竺 标 系 表示 的 JOG 的 
6 | 动作 ”|JOGPSP ”|JOG 步 进行 程 和 速度 倍率 水 半生 冲 放流 认 人 到 

- 设置 “基本 坐标 系 原点 "在 "世界 从 
7 动作 “|MEXBS 基本 坐标 系 偏 置 标 系 ”中 的 位 置 ( 偏 置 ) 

- 标准 工具 坐标 系 " 偏 年 "CTOOL| 设置 " 抓 手 坐 标 系 原点 "在 "机 械 下 
8 | 动作 |MEXTL | 坐标 系 也 称 为 抓 手 坐标 系 ) 坐标 系 "中 的 位 置 ( 偏 置 ) 
9 | 动作 |MEXBSNO | 世界 坐标 系 编号 设置 世界 坐标 系 编号 
10 动作 “|AREA* AT | 报警 类 型 设置 报警 类 型 

动作 ”|USRAREA | 报警 输出 信和 号 设置 输出 信号 
11 | 动作 |AREASPx | 空间 的 一 个 对 角 点 设置 “用 户 定义 区 ”的 一 个 对 角 点 
12 | 动作 |AREAxCS | 基准 坐标 系 设置 “用 户 定义 区 ”的 “基准 坐标 系 ” 
13 | 动作 |AREAY ME | 机 器 人 编号 设置 机 器 人 "编号 ” 
14 | 动作 |SECx AT | 平面 限制 区 有 效 /无 效 选择 设置 平面 限制 区 有 效 无 效 

SFC * Pl 
15 | 动作 ”|SFCxP2 | 构成 平面 的 三 点 设置 构成 平面 的 三 点 
SFC* P3 
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续 表 
序号 | 参数 类 型 | 参数 符号 参数 名 称 参数 功能 
16 动作 “|SFC* ME “| 机 器 人 编号 设置 机 器 人 “编号 ” 
对 动作 |JSAFE 退 避 点 设置 一 个 应 对 紧急 状态 的 退 避 点 
18 动作 “|MORG 机 械 限 位 器 基准 点 设置 机 械 限 位 器 原点 
接近 特异 点 
19 动作 ”| MESNGLSW 是 否 报警 设置 接近 特异 点 是 否 报警 
20 动作 ”|JOGSPMX | 示 教 模式 下 JOG 速度 限制 值 设置 示 教 模式 下 JOG 速度 限制 值 
21 动作 Nr 工件 坐标 系 设置 工件 坐标 系 
2 动作 |WKnWO 工件 坐标 系 原点 
23 动作 |WKnWX 工件 坐标 系 X 轴 位 置 点 
24 动作 |WKnWY 工件 坐标 系 Y 轴 位 置 点 
程序 中 断 执行 JOG 动作 后 的 返 | 设置 程序 中 断 执行 JOG 动作 后 的 
25 动作 ”|RETPATH 回 形 式 返回 形式 
26 动作 ”| MEGDIR 重力 在 各 轴 方 向 上 的 投影 值 设置 重力 在 各 轴 方 向 上 的 投影 值 
27 | 动作 ”| ACCMODE | 最 佳 加 减速 模式 ort 
28 动作 ”|JADL 最 佳 加 减速 倍率 设置 最 佳 加 减速 倍率 
29 动作 ”|CMPERR 伺服 柔性 控制 报警 选择 设置 伺服 柔性 控制 报警 选择 
30 动作 ”|COL 碰撞 检测 设置 碰撞 检测 功能 
31 动作 “|COLLVL 碰撞 检测 级 别 1~5 
32 动作 ”|COLLVLJG |JOG 运行 时 的 碰撞 检测 级 别 1~5 
33 动作 ”|WUPENA “| 预 热 运 行 模式 
34 动作 ”|WUPAXIS “| 预 热 运 行 对 象 轴 
bit ON 对 象 轴 
本 bit OFF 非 对 象 轴 
35 动作 ”|WUPTIME | 预 热 运行 时 间 
设置 单位 : 分 (1 一 60) 
36 动作 ”|WUPOVRD | 预 热 运行 速度 倍率 
到 抓 手 用 电磁 阀 输入 信号 源 型 / 漏 
37 动作 ”| HIOTYPE 型 选择 
设置 电磁 阀 单线 圈 / 双 线圈 及 对 
38 动作 “|HANDTYPE 应 的 外 部 信号 


16.1.2 动作 参数 详解 


为 了 使 读者 更 清楚 参数 的 意义 和 设置 ,本 章 结合 RT TooLBox 软件 的 使 用 进一步 解释 
各 参数 的 功能 ,如 表 16-2 一 表 16-35 所 示 。 


表 16-2 MEJAR 


类 型 参数 符号 参数 名 称 功 能 
es 用 于 设置 各 轴 行 程 范围 
| ley (关节 轴 旋转 范围 ) 


参见 图 16-1 


表 16-3 MEPAR 


类 型 参数 符号 参数 名 称 功 能 
动作 | MEPAR 各 轴 在 直角 坐标 系 的 行程 范围 ee 人 
参见 图 16-1 
表 16-4 用 户 设置 的 原点 Useprog 
类 型 参数 符号 参数 名 称 功 能 
动作 Useprog 用 户 设置 的 原点 用 户 自行 设置 的 原点 
用 户 设置 的 关节 轴 原 点 。 以 初始 原点 为 基准 ,参见 图 16-1 
到 动作 范围 地 数 1:RC1 20150721-142427 加 回国 
| 机 器 1 习 LRY7FD 
关节 动作 范围 0) (MEJAR) “，| 用 户 指定 原点 位 置 U) (USERORG)  ， 直 交 动 作 范围 (4) (MEPAR) 
-mm] + 
1 a : |-10000,00| 10000.00 
2: : | -10000,00| 10000,00 
53; : | -10000.00| 10000.00 
了 4 
5; 
6; 
也 
8: 
图 16-1 行程 范围 及 原点 的 设置 
表 16-5 MELTEXS 
类 型 参数 符号 参数 名 称 功 能 
动作 MELTEXS 机 械 手 前 端 行程 限制 用 于 限制 机 械 手 前 端 对 基 座 的 干涉 
设置 MELTEXS 一 0, 限 制 无 效 ， MELTEXS 一 1, 限 制 有 效 
参数 的 编辑 LE 
着 数 名 : MELTEXS 机 器 号 : 1 
说 明 : Speafication of dosng to body lmit.(The meaning is different depending on the model 
| 1 
Gam | [Aw | [a | 
表 16-6 JOGJSP 
类 型 参数 符号 参数 名 称 功 能 
二 
动作 JOGJSP JOG 步 进 行程 和 速度 倍率 ee 有 第 
[5 
在 JOG 模式 下 ,每 按 一 次 JOG 按键 ,( 轴 ) 移 动 一 个 “ 定 长 距离 ”, 就 称 为 步 进 。 参 见 图 16-2 
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表 16-7 JOGPSP 


类 型 参数 符号 参数 名 称 功 能 
向 i 设置 以 直角 坐标 系 表示 的 JOG 的 步 
动作 JOGPSP JOG 步 进行 程 和 速度 倍率 进行 程 和 速度 倍率 


参数 JOGPSP 与 JOGJSP 可 用 于 示 教 时 的 精确 动作 , 步 进行 程 越 小 ,调整 越 精确 ,参见 图 16-2 


机 器 1 
RY-7FD 


关节 OG 速度 (2) ()OGJ5P) 


定 十 H; 0.10 
定 十 L; 0.01 
速度 比率 :| 。 100.00 


直 交 0G 速度 (%) (OOGPSP) 


定 十 H: 1.00| 
定 寸 L: 0.50 


速度 比率 ; | 100.00 


说 明 画 面 (E) 


图 16-2 参数 JOGPSP 与 JOGJSP 的 设置 


表 16-8 MEXBS 


类 型 参数 符号 参数 名 称 功 能 
本 设置 “基本 坐标 系 原点 ”在 “世界 坐标 
动作 MEXBS 基本 坐标 系 偏 置 系 ”中 的 位 置 ( 偏 置 ) 
设置 参见 图 16-3 
表 16-9 MEXTL 
类 型 参数 符号 参数 名 称 功 能 
动作 i 标准 工具 坐标 系 “ 偏 置 ”TOOL 设置 “ 抓 手 坐标 系 原点 "在 “机 械 正 
坐标 系 也 称 为 抓 手 坐标 系 ) 坐标 系 ” 中 的 位 置 ( 偏 置 ) 
设置 参见 图 16-3 
表 16-10 工具 坐标 系 “ 偏 置 "(16 个 ) 
类 型 参数 符号 参数 名 称 功 能 
i 设置 TOOL 坐标 系 。 可 设置 16 个 ， 
动作 MEXTL1~16 TOOL 坐标 系 偏 置 互相 切换 


参见 图 16-3 


TOQL 数 据 1~ AC) 
Too 14 > 


MEXTL1 MEXTL2 MEXTL3 MEXTL4 
[om deg] fmm deg] mm, deg] nm, deg] 
日 0.00 0.00 0.00 0.00 
0.00 0.00 
0.00 0.00 


0.00 0.00 
0.00 


图 16-3 基本 坐标 系 偏 置 和 TOOL 坐标 系 偏 置 的 设置 


表 16-11 世界 坐标 系 编号 


类 型 参数 符号 参数 名 称 功 能 
动作 MEXBSNO 世界 坐标 系 编号 设置 世界 坐标 系 编号 
MEXBSNO=0, 初 始 设置 ; MEXBSNO=1 一 8, 工 件 坐 标 系 。 


设置 如 果 是 由 base 指令 设置 “世界 坐标 系 ” 或 直接 设置 为 “标准 世界 坐标 系 ” 时 ,在 读 取 状 态 下 ， 
MEXBSNO=—1 


这 样 “ 工 件 坐 标 系 ”也 可 以 理解 为 “世界 坐标 系 ” 


用 户 定义 区 是 用 户 自行 设 定 的 “空间 区 域 "。 如 果 机 器 人 控制 点 进入 设 定 的 “区 域 后 ”， 
系统 会 做 相关 动作 。 
设置 方法 : 以 两 个 对 角 点 设置 一 个 空间 区 域 ,如 图 16-4 所 示 。 


z 
上 
AREA1P2 AREAIPI1 AREA2P1 AREA2P2 
(x12, y12, z12) (x11,y11,z11) (x21, y21, 221) (X22, y22, Z22 
pal 


一 和 | 一 使 用 者 定义 区 2 


: 


i 


Mle 
坐标 系 由 AREAnCS 定 义 
图 16-4 用 户 定义 区 章 


第 16 日 一 一 参 履 的 功能 及 谈 置 (1) 


30 日 学 嵌 工 业 胡 器 人 


设置 动作 方法 : 如 果 机 器 人 控制 点 进入 设 定 的 区 域 后 ,系统 如 何 动作 ? 可 设置 为 : 无 
动作 /有 输出 信号 /有 报警 输出 。 

0: 无 动作 。 

1: 输出 专用 信和 号。 

进入 区 域 1, x**x 信号 = 二 ON。 

进入 区 域 2, *x*x 信和 号 = 二 ON。 

进入 区 域 3, *x*x 信和 号 = 二 ON。 

表 16-12 AREA*AT 


类 型 参数 符号 参数 名 称 功 能 
动作 AREA * AT 报警 类 型 设置 报警 类 型 
设置 AREA * AT=0, 无 报警 AREA * AT==1, 信 和 号 输出 ; AREA * AT=2, 报 警 输出 
如 图 16-5 所 示 


表 16-13 USRAREA 


类 型 参数 符号 参数 名 称 功 能 
动作 USRAREA 报警 输出 信号 设置 输出 信号 
设置 设置 最 低位 和 最 高 位 的 输出 信号 (如 27 一 30)? 
如 图 16-5 所 示 


表 16-14 AREASP* 


类 型 参数 符号 参数 名 称 功 能 
动作 AREASP* 空间 的 一 个 对 角 点 设置 “用 户 定义 区 ”的 一 个 对 角 点 
设置 
如 图 16-5 所 示 


Xx: 
Y: 
Z: 
A: 
B: 
C: 


ee 
Sc 


图 16-5 用 户 定义 区 的 参数 设置 


表 16-15 AREA * CS 


类 型 参数 符号 参数 名 称 功 能 
动作 AREA * CS 基准 坐标 系 设置 “用 户 定义 区 ”的 “基准 坐标 系 ” 
设置 AREA * CS 一 0, 世 界 坐标 系 ; AREA * CS 一 1, 基 本 坐标 系 
本 参数 用 于 选择 设置 “用 户 定义 区 ”的 “坐标 系 "。 可 以 选择 “世界 坐标 系 "“ 基 本 坐标 系 ” 


表 16-16 AREA* ME 


类 型 参数 符号 参数 名 称 功 能 
动作 AREA * ME 机 器 人 编号 设置 机 器 人 “编号 ” 
补 加 AREA * ME 一 0, 无效 ; AREA * ME 一 1, 机 器 人 1( 常 设 ); AREA * ME 一 2, 机 器 人 2; 


AREA * ME 一 3, 机 器 人 3 


自由 平面 限制 SFCNP1 是 设置 行程 范围 的 一 种 方法 。 
以 任意 设置 的 平面 为 界 设置 限制 范围 (在 平面 的 前 面 或 后 
面 ), 如 图 16-6 所 示 , 由 参数 SFCnAT 设置 。 

由 三 点 构成 一 个 任意 平面 。 以 这 个 任意 平面 为 界限 , 限 
制 机 器 人 的 动作 范围 ,可 以 设置 8 个 任意 平面 。 可 以 规定 机 
器 人 的 动作 范围 是 在 原点 一 侧 还 是 不 在 原点 一 侧 , 如 图 16-6 


所 示 。 图 16-6 自由 平面 限制 的 定义 
表 16-17 SFC* AT 
类 型 参数 符号 参数 名 称 功 能 
动作 SFC* AT 平面 限制 区 有 效 / 无 效 选择 设置 平面 限制 区 有 效 / 无 效 
SFC * AT==0, 无 效 ; SFC * AT 一 1, 可 动作 区 在 原点 一 侧 。SFC * AT 一 一 1, 可 动作 区 在 无 
设置 
原点 一 侧 
参见 图 16-7 


表 16-18 SFC * P1 


类 型 参数 符号 参数 名 称 功 能 
SFC* P1 
动作 SFC* P2 构成 平面 的 三 点 设置 构成 平面 的 三 点 
SFC * P3 


设置 参见 图 16-7 


表 16-19 SFC* ME 


类 型 参数 符号 参数 名 称 功 能 
动作 SFC* ME 机 器 人 编号 设置 机 器 人 “编号 ” 
设置 SFC x ME==1, 机 器 人 1; SFC* ME 一 2, 机 器 人 2; SFC* ME 一 3, 机 器 人 3 
参见 图 16-7 
16 
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16-7 自由 平面 限制 的 参数 设置 


表 16-20 退 避 点 
类 型 参数 符号 参数 名 称 功 能 
动作 JSAFE 退 避 点 设置 一 个 应 对 紧急 状态 的 退 避 点 
设置 以 关节 轴 的 “度数 ”(deg) 为 单位 进行 设置 


参见 图 16-8 


操作 时 ,可 用 示 教 单元 定好 “ 退 避 点 "位 置 。 如 果 通 过 外 部 信号 操作 , 则 必须 分 配 好 “ 退 
避 点 启动 ”信号 ,如 图 16-9 所 示 。 输 入 信号 23 为 “ 退 避 点 启动 ”信号 。 


| 
[sveos ， 国 


通用 输出 信号 复位 
机 器 锁定 


图 16-8 退 避 点 的 设置 图 16-9 启动 回 “ 退 避 点 ”信号 


具体 操作 步骤 如 下 。 

(1) 选择 自动 状态 ; 

(2) 伺服 二 ON; 

(3) 启动 “ 回 退 避 点 ”信和 号 。 


表 16-21 MORG 


类 型 参数 符号 参数 名 称 功 能 
动作 MORG 机 械 限 位 器 设置 机 械 限 位 器 原点 
设置 (J1,J2,J3,J4,J5,J6,J7,J8) 

基数 名 : MORG 
说 明 : Mechanical stopper origin (Jont coordinate) 
; 243.00 5: 121.00 
: -116.00 : 0.00 
: 158.00 
: 203.00 
表 16-22 MESNGLSW 

类 型 参数 符号 参数 名 称 功 能 
接近 特异 点 3 
动作 MESNGLSW 是 否 报警 设置 接近 特异 点 是 否 报警 
设置 MESNGLSW==0, 无 效 ; MESNGLSW 王 1, 有 效 

扰 数 名 : MESNGLSW 机 器 号 : 0 
说 明 : Singular point neighborhood warning ON(1)/OFF(0) 
表 16-23 示 教 模式 下 JOG 速度 限制 值 JOGSPMX 

类 型 参数 符号 参数 名 称 功 能 
动作 JOGSPMX 示 教 模式 下 JOG 速度 限制 值 设置 示 教 模式 下 JOG 速度 限制 值 
设置 

参政 的 妨 名 __ 
坟 才 名 : JOGSPMX 机 器 号 : 1 | 


说 明 : JOG maximum speed (under 250[mmysec]) 


1: ho000.00 


pe) La 


第 


第 16 日 一 一 参 烙 的 功能 及 设置 (1) 


30 日 学 嵌 工 业 胡 器 人 


表 16-24 工件 坐标 系 


类 型 参数 符号 参数 名 称 功 能 
动作 ee 工件 坐标 系 设置 工件 坐标 系 
WOWO 工作 至 标 系 原点 
WEKnWX 工件 坐标 系 久 轴 位 置 点 
WEKnWY 工作 坐标 系 立轴 位 置 点 
， 可 设置 8 不 工作 符 标 系 
参看 图 16-10 


E 


工件 坐标 系 
WKnCORD 


示 教 点 : WO 


+Zw 


示 教 点 : WX 
+ 
+1Xw 基本 坐标 系 
工件 +X 
16-10 工件 坐标 系 设置 示意 图 
设置 工件 坐标 系 要 注意 以 下 两 点 。 


(1) 工件 坐标 系 的 X 轴 、Y 轴 方向 最 好 要 与 基本 坐标 系 ” 一 致 。 
(2) 工件 坐标 系 原点 只 保证 X/Y/Z 轴 坐 标 ,不 能 满足 ABC 角度 。 


表 16-25 RETPATH 


类 型 参数 符号 参数 名 称 功 能 
程序 中 断 执行 JOG 动作 后 的 返 | 设置 程序 中 断 执行 JOG 动作 后 的 返 
动作 RETPATH 回 形 式 回 形 式 
设置 RETPATH 二 0, 无 效 ; RETPATH==1, 以 关节 插 补 返回 ; RETPATH==2, 以 直 交 插 补 返回 


在 程序 执行 过 程 中 ,可 能 遇 到 不 能 满足 工作 要 求 的 程序 段 ,需要 在 线 修改 ,系统 提供 了 
在 中 断后 用 JOG 方式 修改 的 功能 。 本 参数 设置 在 JOG 修改 完成 后 返回 原 自动 程序 的 


形式 。 
图 16-11 是 一 般 形式 ,图 16-12 是 在 “连续 轨迹 运行 CNT 模式 ”下 的 返回 轨迹 。 


再 启动 自动 运行 往 目的 位 置 
移动 


再 启动 自动 运行 


返回 原始 位 置 


RETPATH=1 或 =2 的 情况 RETPATH=0 的 情况 


图 16-11 在 自动 程序 中 断 进行 JOG 修正 后 返回 的 轨迹 


RETPATH=1 或 =2 的 情况 RETPATH=0 的 情况 


图 16-12 工件 在 “连续 轨迹 运行 CNT 模式 "下 的 返回 轨迹 


表 16-26 重力 方向 


类 型 参数 符号 参数 名 称 功 能 


动作 MEGDIR 重力 在 各 轴 方 向 上 的 投影 值 设置 重力 在 各 轴 方 向 上 的 投影 值 
设置 参见 图 16-13 


由 于 安装 方位 的 影响 ,重力 加 速度 在 各 轴 的 投影 值 不 同 , 如 图 16-13 所 示 ,所 以 要 分 别 
设置 。 

以 图 16-13 倾斜 30 为 例 : 

X 轴 重 力 加 速度 (Xg) 二 9. 8Xsin(30") 一 4.9。 

Z 轴 重 力 加 速度 (Zg) 二 9. 8Xcos(30°) 二 8.5。 

因为 Z 轴 与 重力 方向 相反 ,所 以 为 一 8.5。 


YY 轴 重 力 加 速度 (Yg) 二 0.0。 和 
所 以 设 定 值 为 (3.0, 4.9, 0.0, 一 8.5)。 章 


第 16 日 一 一 委 数 的 功能 及 设置 (7) 
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设 定 值 
安装 姿势 (安装 姿势 ，X 轴 的 重力 加 速度 ， 
Y 轴 的 重力 加 速度 ，Z 轴 的 重力 加 速度 ) 
放置 地 板 (0.0, 0.0, 0.0, 0.0) 
| 壁挂 (1.0, 0.0, 0.0, 0.0) 
| 垂 吊 (2.0, 0.0, 0.0, 0.0) 
| 任意 的 姿势 *1 (3.0， 站 机 让 市， 说 机 
图 16-13 重力 在 各 轴 方 向 上 的 投影 
表 16-27 ACCMODE 
类 型 参数 符号 参数 名 称 功 能 
动作 ACCMODE 最 佳 加 减速 模式 和 人 全 全 于 
设置 ACCMODE==0, 无 效 ; ACCMODE=1, 有 效 
如 图 16-14 所 示 
表 16-28 JADL 
类 型 参数 符号 参数 名 称 功 能 
动作 JADL 最 佳 加 减速 倍率 设置 最 佳 加 减速 倍率 
设置 
如 图 16-14 所 示 
表 16-29 CMPERR 
类 型 参数 符号 参数 名 称 功 能 
动作 CMPERR 伺服 柔性 控制 报警 选择 设置 伺服 柔性 控制 报警 选择 
设置 CMPERR 一 0, 不 报警 ; CMPERR 一 1 ,报警 


参见 图 16-14 


图 16-14 最 佳 加 减速 模式 及 重力 影响 参数 的 设置 


表 16-30 COL 
类 型 参数 符号 参数 名 称 功 能 
动作 COL 碰撞 检测 设置 碰撞 检测 功能 
COLLVL 碰撞 检测 级 别 1%~500% 
COLLVLJG JOG 运行 时 的 碰撞 检测 级 别 1%~500% 
设置 数值 越 小 ,灵敏 度 越 高 


参见 图 16-15 


下 "| 


| 


图 16-15 碰撞 检测 相关 参数 的 设置 
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需要 做 以 下 设置 。 

(1) 设置 碰撞 检测 功能 COL 功能 的 有 效 / 无 效 ; 

(2) 上 电 后 的 初始 状态 下 碰撞 检测 功能 COL 功能 的 有 效 /无 效 ; 
(3) JOG 操作 中 ,碰撞 检测 功能 COL 功能 的 有 效 / 无 效 。 
COLLVL: 自动 运行 时 的 碰撞 检测 的 量 级 。 

COLLVLJG: JOG 运行 时 的 碰撞 检测 的 量 级 。 


表 16-31 预 热 运行 


类 型 参数 符号 参数 名 称 功 能 
动作 WUPENA 预 热 运行 模式 
WUPENA=0 无 效 ; 
下 WUPENA=1 有 效 
WUPAXIS 预 热 运行 对 象 轴 
bit ON 对 象 轴 
设置 bit OFF 非 对 象 轴 
WUPTIME 预 热 运行 时 间 
设置 单位 : 分 (1 一 60) 
WUPOVRD 预 热 运行 速度 倍率 


设置 参见 图 16-16 和 图 16-17 


暖 机 运行 


100% 


初始 值 
(70%) 


|_ 值 为 固定 的 时 间 _ | 在 对 象 册 动作 的 时 间 
(30s) 


| 暧 机 运行 状态 的 有 效 时 间 __。 | 
(60s) 
图 16-16 ” 预 热 运行 的 速度 变化 


在 低温 或 长 期 停机 后 启动 .需要 进行 预 热 运行 (否则 可 能 导致 精度 误差 )。 预 热 运行 的 
本 质 是 降低 速度 ,实际 通过 降低 速度 倍率 来 实现 。 

设置 参数 如 下 。 

WUPENA 一 一 设置 预 热 模式 有 效 / 无 效 。0: 无 效 ; 1: 有 效 。 

WUPAXIS 一 一 设置 进入 预 热 模式 的 轴 。 

WUPTIME 一 一 预 热 运行 有 效 时 间 。 

再 启动 时 间 一 一 如 果 有 某 些 轴 预 热 后 一 直 停止 没有 运行 ,经 过 设置 时 间 后 再 次 启动 预 
热 运 行 ,这 段 时 间 就 是 “再 启动 时 间 ”。 

WUPOVRD 一 一 预 热 运行 的 速度 倍率 。 

恒定 值 时 间 段 比例 一 一 速度 倍率 为 “恒定 (直线 段 ) 的 时 间 ” 相 对 “总 预 热 有 效 时 间 ” 的 


比例 。 


FRV#5 
星 机 运行 模式 对 象 轴 (A) (WUPAXIS) 


加 1 回 2 加 3 回 » 
;ss 回 5 Ey 四? 


是 机 运行 速度 比率 4) (WuPOVRD) 


16-17 ” 预 热 模式 的 相关 参数 设置 


抓 手 参数 的 设置 实际 上 是 对 使 用 电磁 阀 的 设置 。 电 磁 阀 分 为 单 向 电磁 阅 和 双向 电磁 
阀 。 可 以 直接 使 用 外 部 输入 输出 信号 控制 电磁 阀 , 在 程序 中 直接 发 输入 输出 指令 即 可 。 


表 16-32 HIOTYPE 


类 型 参数 符号 参数 名 称 功 能 
抓 手 用 电磁 阀 输入 信号 源 型 / 漏 
动作 HIOTYPE 型 选择 
设置 HIOTYPE= 二 0, 源 型 ; HIOTYPE 一 1, 漏 型 

参数 名 : HIOTYPE 机 器 号 : 0 
说 明 : Wo type of HAND WF.(0:SOURCE / 1:SINK) 
表 16-33 HANDTYPE 

类 型 参数 符号 参数 名 称 功 能 
a 设置 电磁 阀 单线 圈 / 双 线圈 及 对 
动作 HANDTYPE 应 的 外 部 信号 
设置 HANDTYPE 一 s** ,单线 圈 ; HANDTYPE 王 D** , 双 线 圈 ; HANDTYPE 王 UMAC, 特 殊 


规格 


参数 名 : HANDTYPE 机 器 号 : 工 
说 明 : Control type for HAND1-8 (single/double/special=S***/D***/UMAC*) 

1: pb900 -| 

2: D902 6: 

3: D904 7: 

4: D906 8: 第 
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参数 HANDTYPE 用 于 设置 电磁 阀 的 类 型 ( 单 向 、 双 向 ) 和 连接 外 部 信号 的 地 址 号 。 

HANDTYPE 王 D10 一 一 表示 抓 手 1 是 双向 电磁 阀 , 外 部 输入 信号 地 址 为 (10、11)。 

HANDTYPE= D10, D12 一 一 表示 抓 手 1 是 双向 电磁 阀 ,外 部 输入 信号 地 址 为 (10、 
11); 抓 手 2 是 双向 电磁 阀 ,外 部 输入 信号 地 址 为 (12、13) 。 

HANDTYPE=S10, S11, S12 一 一 表示 抓 手 1 是 单 向 电磁 阀 ,外 部 输入 信号 地 址 为 
(10); 抓 手 2 是 单 向 电磁 阀 , 外 部 输入 信号 地 址 为 (11) 。 

抓 手 3 是 单 向 电磁 阀 ,外 部 输入 信号 地 址 为 (13) 。 


表 16-34 HANDINIT 


类 型 参数 符号 参数 名 称 功 能 
动作 HANDINIT 气动 抓 手 的 初始 界面 状态 
设置 
参数 名 : HANDINIT SS: 1 
说 明 : Initial status for ar hand WF 
1:h 5: 1 
2:0 6:0 
1 | 1 
4:0 8:0 
HANDINIT 一 一 表示 上 电 时 ,各 抓 手 的 “ 开 ” 或 “ 关 ” 状 态 。 
出 厂 设置 如 下 : 
输出 信号 号 码 的 状态 
抓 手 的 种 类 状态 
机 器 1 机 器 2 机 器 3 
900=1 910=1 920=1 
有 901=0 911=0 921=0 
902=1 912=1 922=1 
安装 气动 抓 手 1/F 时 2 下 903 一 0 913 一 0 923 一 0 
(假设 为 双 线 螺 管 ) a 904 一 1 914 一 1 924 一 1 
打 寺 3 天 905=0 915=0 925=0 
906=1 916=1 926=1 
时 二 枯 907=0 917=0 927 一 0 


如 图 16-18 所 示 设 置 为 上 电 后 ,各 抓 手 全 部 为 “ 开 状态 ”。 


者 数 名 : HANDINIT 机 器 号 : 1 
WAM: Intal status for ar hand WF 


图 16-18 参数 HANDINIT 的 设置 


如 图 16-19 所 示 设 置 为 上 电 后 ,1 号 抓 手 为 “ 关 状 态 ”"。 上 电 以 后 的 初始 状态 关系 到 安 
全 性 ,如 果 上 电 后 抓 手打 开 , 可 能 会 造成 原来 夹 持 的 工件 掉 落 ,使 用 设置 时 必须 特别 注意 。 


图 16-19 参数 HANDINIT 的 设置 


主要 是 信号 地 址 的 设置 ,在 图 16-20 中 控制 电磁 阀 的 信号 一 一 外 部 1/O 卡 上 的 输出 信 
号 地 址 是 12。 在 自动 程序 中 使 用 HOpen 1/HClose 1 指令 就 可 以 直接 控制 抓 手 动作 。 


图 16-20 抓 手相 关 参 数 的 设置 


表 16-35 HNDHOLD1 


类 型 参数 符号 参数 名 称 功 能 
动作 HNDHOLD1 抓 手 开 状 态 与 夹 持 工件 关系 
设置 HNDHOLD1=0, 不 夹 持 工件 ; HNDHOLD1=1, 夹 持 工件 


元 数 名 : HNDHOLD1 机 器 号 : 1 


说 明 : Definition work grasp for hand 1 (0/1 = no work/with work) 


N 
=[ 志 | 


本 参数 是 指 在 抓 手 “打开 ”状态 下 ,是 夹 持 工件 还 是 不 夹 持 工件 ( 即 工作 方式 是 外 张 式 还 | 第 
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16.2 程序 型 参数 


16.2.1 程序 型 参数 一 览 表 


如 表 16-36 所 示 是 程序 型 参数 一 览 表 。 
表 16-36 ”程序 型 参数 一 览 表 


序号 | 参数 类 型 参数 符号 参数 名 称 参数 功能 
用 于 设置 每 一 任务 区 内 的 程序 

任务 区 内 的 程序 名 、 运 行 模式 、 Se 机 | 

和 程序 “|SLT 启动 条 件 .执行 程序 行 数 tl 

2 程序 |TASKMAX 多 任务 个 数 设置 同时 执行 程序 的 个 数 

3 程序 ”|SLOTON 程序 选择 记忆 设置 已 经 选择 的 程序 是 否 保持 

4 程序 ”|CTN 继续 运行 功能 

5 程序 ”|PRGMDEG bd 

6 程序 ”|PRGGBL 程序 保存 区 域 大 小 

了 程序 “|PRGUSR 用 户 基本 程序 名 称 

8 程序 |ALWENA 特殊 指令 允许 执行 选择 选择 一 些 特殊 指令 是 否 允 许 执行 

9 程序 |JRCEXE JRC 指令 执行 选择 设置 JRC 指令 是 否 可 以 执行 

10 程序 ”|JRCQTT JRC 指令 的 单位 设置 JRC 指令 的 单位 

a 程序 ”|JRCORG JRC 指令 后 的 原点 设置 JRC 0 时 的 原点 位 置 

12 程序 ”|AXUNT 附加 轴 使 用 单位 选择 设置 附加 轴 的 使 用 单位 

13 程序 ”|UER1~UER20 | 用 户 报警 信息 编写 用 户 报警 信息 

14 程序 ”|RLNG 机 器 人 使 用 的 语言 设置 机 器 人 使 用 的 语言 

15 程序 ”|LNG 显示 用 语言 设置 显示 用 语言 

i 程序 “|PsT 程序 号 选择 方式 在 START 信号 输入 的 同时 ,使 
是 用 外 部 信号 选择 程序 的 方法 |“ 外 部 信号 选择 的 程序 号 "有 效 

17 | 程序 |INB STOP 信号 改 “B 触 点 ” Ey 有 
EMGOUT 对 应 的 报警 类 型 和 | 设置 EMGOUT 报警 接口 对 应 的 

Ww | 和 本 ER .mm 报警 类 型 和 级 别 


16.2.2 程序 参数 详解 


程序 参数 是 指 与 执行 程序 相关 的 参数 ,如 表 16-37 一 表 16-55 所 示 。 
任务 区 设置 ( 搬 槽 区 task slot) ,如 表 16-37 所 示 。 


表 16-37 任务 区 设置 


类 型 参数 符号 参数 名 称 功 能 

程序 i 任务 区 内 的 程序 名 、 运 行 模式 、| 用 于 设置 每 一 任务 区 内 的 程序 名 、 运 
启动 条 件 ,执行 程序 行 数 行 模式 、 启 动 条 件 \ 执 行程 序 行 数 

设置 参见 图 16-21 


本 参数 用 于 设置 每 一 任务 区 内 的 “程序 名 ”运行 模式 .启动 条 件 、 执 行程 序 行 数 。 

设置 内 容 如 下 。 

(1) 程序 名 : 只 能 用 大 写字 母 ,小 写 不 
识别 。 

(2) 运行 模式 : REP/CYC。 

@ REP 一 一 程序 连续 循环 执行 。 

@ CYC 一 一 程序 单 次 执行 。 

(3) 启动 条 件 ，START/ALWAYS/ 
ERROR 。 

@ START: 由 start 信和 号 启动 。 

@ ALWAYS: 上 电 立 即 启动 。 图 16-21 任务 区 的 设置 

@ ERROR: 发 生 报警 时 启动 (多 用 于 报 
警 应 急 程序 ,不 能 执行 有 关 运 动 的 动作 ) 。 

表 16-38 TASKMAX 


类 型 参数 符号 参数 名 称 功 能 
程序 TASKMAX 多 任务 个 数 设置 同时 执行 程序 的 个 数 
设置 初始 值 : 8 


: 
! 


同时 执行 程序 ,只 可 能 一 个 是 动作 程序 ,其 余 为 数据 信息 处 理 程序 ,这 样 就 不 会 出 现 混 
乱 动 作 的 情况 。 
表 16-39 ”程序 选择 记忆 
类 型 参数 符号 参数 名 称 功 能 
动作 SLOTON 程序 选择 记忆 设置 已 经 选择 的 程序 是 否 保持 


SLOTON=0 记忆 无 效 ” 非 保持 
SLOTON=1 记忆 有 效 非 保 持 


有 SLOTON=2 记忆 无 效 保持 
SLOTON=3 记忆 有 效 保持 
参见 图 16-22 


本 参数 用 于 设置 选择 程序 在 断 电 -上 电 后 是 否 保持 原来 的 选择 状态 。 设 置 方式 参见 
图 16-22。 


记忆 : 断 电 -上 电 后 保持 原来 选择 程序 (在 任务 区 1 内 ) 。 
保持 , 程序 循环 执行 结束 后 是 否 保持 原 程序 名 。0: 不 保持 ; 1: 保持 。 家 
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16-22 参数 SLOTON 设置 


表 16-40 CTN 
类 型 参数 符号 参数 名 称 功 能 
在 程序 执行 过 程 中 ,如 果断 电 , 则 保 
存 所 有 工作 状态 ,在 上 电 后 从 断 电 处 
和 全 全 下 作 天 允 开始 执行 (因此 必须 特别 注意 安全 )。 
视觉 指令 不 支持 这 一 功能 
设置 CTN=0, 无 效 ; CTN==1, 有 效 
葡 数 名 : CTN 机 器 号: 0 
说 明 : Continue function Disable/Enable (0/1) 
表 16-41 PRGMDEG 
类 型 参数 符号 参数 名 称 功 能 
动作 i she at 
设置 PRGMDEG 二 0 时 单位 为 RAD( 弧 度 ) ,PRGMDEG 二 1 时 单位 为 DEG( 度 ) 


每 一 点 的 位 置 数 据 为 (X.Y,Z,A,B,C) ,其 中 ,A/B/C 为 旋转 轴 部 分 。 本 参数 用 于 设置 


A/B/C 旋转 轴 的 单位 是 “弧度 ”还 是 “ 度 ”。 初 始 设 置 为 度 (deg) 。 


表 16-42 PRGGBL 


类 型 参数 符号 参数 名 称 功 能 
动作 BI 程序 保存 区 域 大 小 ea 
设置 PRGGBL=0, 标 准 型 ; PRGGBL==1, 扩 展 型 


参数 名 : PRGGBL 机 器 号 : 0 


说 明 : System global varable(0:Standard/1:Ext.) 


表 16-43 用户 基 本 程序 名 称 


类 型 参数 符号 参数 名 称 功 能 
动作 PRGUSR 用 户 基本 程序 名 称 设置 用 户 基本 程序 名 称 
设置 


用 户 基本 程序 是 定义 “全 局 变量 ”的 程序 ,内 容 仅 为 Def Inte 或 Dim 


表 16-44 ALWENA 
类 型 参数 符号 参数 名 称 功 能 


动作 ALWENA 特殊 指令 允许 执行 选择 规定 一 些 特殊 指令 是 否 允许 执行 


ALWENA 二 0, 不 可 执行 ; ALWENA 二 1, 可 执行 。 
设置 对 于 上 电 就 启动 执行 的 程序 简称 为 “上 电 执 行程 序 ”, 在 * 上 电 执 行程 序 ” 中 , 某 些 特殊 指令 
Xrun、Xload、Xstp、Servo、Xrst、Reset Error 是 否 能 够 执行 需要 通过 本 参数 设置 


表 16-45 JRCEXE 


类 型 参数 符号 参数 名 称 功 能 
设置 JRC 指令 是 否 可 以 执行 
动作 JRCEXE JRC 指令 执行 选择 JRCEXE 二 0, 不 可 执行 ; 
JRCEXE==1, 可 执行 
JRCQTT JRC 指令 的 单位 设置 JRC 指令 的 单位 
JRCORG JRC 指令 后 的 原点 JRCORG 设置 JRC 0 时 的 原点 位 置 
设置 


表 16-46 AXUNT 


类 型 参数 符号 参数 名 称 功 能 
动作 AXUNT 选择 附加 轴 使 用 单位 设置 附加 轴 的 使 用 单位 第 
设置 AXUNT 一 0, 角 度 (deg); AXUNT 一 1 ,长 度 Cmm) 16 
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表 16-47 UER 
类 型 参数 符号 参数 名 称 功 能 
程序 UER1~ UER20 用 户 报警 信息 编写 用 户 报警 信息 
设置 用 户 自行 编制 的 “报警 信息 ” 

表 16-48 RLNG 
类 型 参数 符号 参数 名 称 功 能 
程序 RLNG 机 器 人 使 用 的 语言 设置 机 器 人 使 用 的 语言 
设 量 RLNG=2,MELFA-BASIC V; 


RLNG=1,MELFA-BASIC IV 


机 器 人 语言 () (RLNG) 


加 MOVEMASTER 指 令 


© MELFABASICINY 


MELFA-BASICY 


EE 


表 16-49 LNG 
类 型 参数 符号 参数 名 称 功 能 
程序 LNG 显示 用 语言 设置 显示 用 语言 
设置 LNG=JPN, 日 语 ; LNG 一 ENG ,英语 
甸 数 的 第 镶 
参数 名 : LNG 机 器 号 : 0 
说 明 :Language(JPN:Japanese,ENG:Engish) 
* ENG 
表 16-50 PST 
类 型 参数 符号 参数 名 称 功 能 
程序 Ee 程序 号 选择 方式 在 START 信号 输入 的 同时 ,使 外 部 
用 外 部 信号 选择 程序 的 方法 信号 选择 的 程序 号 有 效 
设置 PST==0, 无 效 ; PST=1, 有 效 
基数 名 : PST 机 器 号 : 0 
襄 明 : prog. No. read starting (1:Enable,0:Disable) 
表 16-51 INB 
类 型 参数 符号 参数 名 称 功 能 
信号 INB STOP 信号 改 “B 触 点 ” 2 对 stop、 stopl, skip 信号 进行 
设置 INB=0,A 触 点 ; INB 一 1,B 触 点 
参数 名 : INB 机 器 吕 : 0 
说 明 : Stop mput signal normaly open(0)/dose(1) 
表 16-52 ROBOTERR 
类 型 参数 符号 参数 名 称 功 能 
n EMGOUT 对 应 的 报警 类 型 和 | 设置 EMGOUT 报警 接口 对 应 的 报 
i 级 别 警 类 型 和 级 别 
设置 通常 设置 为 “7” 
天数 名 : ROBOTERR 机 器 号 : 0 


说 明 : Bit pattem of robot error output signal setting (0-7:GUH) 
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表 16-53 E7730 
类 型 参数 符号 参数 名 称 


动作 E7730 解除 CCLINK 报警 


设置 E7730 二 0, 不 可 解除 ; E7730 二 1, 可 解除 


参数 名 : E7730 机 器 号 : 0 


说 明 : CC-Link emor s canceled temporariy(1:Enable,0:Disable) 


表 16-54 ORSTO 


类 型 参数 符号 参数 名 称 功 能 
i 设置 当 CLR 指令 或 OUTRESET 信 
动作 ORSTO 输出 信号 的 复位 模式 号 时 ,输出 信号 如 何 动作 


设置 参见 图 16-23 和 图 16-24 


都 数 名 : ORSTO 机 器 号 : 0 


说 明 : Output sgnal reset pattemn00-31 


: booooooo 


: 00000000 


: 00000000 


和 IN 


: 00000000 


程序 复位 的 8 拘 输出 信号 四 位 (Snsno) 。 厨 二 a] (是 (0 |] 


了 ] ORSTO -ORST224 


图 16-23 输出 信号 复位 模式 参数 


16-24 ”ORSTO0 参数 的 设置 


“保持 ?的 含义 是 保持 输出 信号 原来 的 状态 。 即 复位 前 为 ON, 就 为 ON, 复 位 前 为 


OFF ,就 为 OFF 。 


表 16-55 SLRSTIO 


类 型 参数 符号 参数 名 称 功 能 
a 程序 复位 时 是 否 执行 输出 信号 
动作 SLRSTIO 的 复位 
设置 SLRSTIO=0, 不 执行 ; SLRSTIO==1, 执 行 


续 表 


套数 名 : SLRSTIO 机 器 号 : 0 
说 明 : Output sgnal reset with SLOTINIT (1:ON, 0:OFF) 


16.3 需要 思考 的 问题 


(1) 动作 型 参数 主要 包含 哪些 方面 的 内 容 ? 

(2) 程序 型 参数 主要 包含 哪些 方面 的 内 容 ? 

(3) 如 何 设置 机 器 人 在 直角 坐标 系 内 的 行程 范围 ? 

(4) 什么 是 基本 坐标 系 偏 置 ? 如 何 设 置 基本 坐标 系 偏 置 ? 

(5) 使 用 什么 参数 设置 任务 区 内 的 “程序 名 ”运行 模式 “启动 条 件 “ 执 行程 序 行 数 ”? 
(6) 如 何 设置 程序 号 选择 方式 ? 
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LT 


第 17 日 一 一 参数 的 功能 及 设置 (2) 


17.1 操作 型 参数 


1 操作 参数 一 览 表 
如 表 17-1 所 示 是 操作 型 参数 一 览 表 。 


表 17-1 操作 型 参数 一 览 表 


序号 参数 符号 参数 名 称 及 功能 出 厂 值 

BZR 设置 报警 时 蜂 鸣 器 音响 OFF/ON 1(ON) 
程序 复位 操作 权 

?| PRSTENA | 设置 “程序 复位 操作 "是否 需要 操作 权 SR 
3 MDRST 随 模式 转换 进行 程序 复位 0( 无 效 ) 
4 OPDISP 操作 面板 显示 模式 
§ OPPSL 操作 面板 为 AUTO 模式 时 的 程序 选择 操作 权 1(OP) 
6 RMTPSL 操作 面板 的 按键 为 AUTO 模式 时 的 程序 选择 操作 权 0 (外 部 ) 
7 OVRDTB 示 教 单元 上 改变 速度 倍率 的 操作 权 选 择 ( 不 必要 一 0, 必 要 =1) | 1( 必 要 ) 
8 OVRDMD 模式 变更 时 的 速度 设 定 
9 OVRDENA 改变 速度 倍率 的 操作 权 ( 必 要 一 0, 不 必要 一 1) 0( 必 要 ) 
10 ROMDRV 切换 程序 的 存 取 区 域 
11 | BACKUP 将 RAM 区 域 的 程序 复制 到 ROM 区 
12 | RESTORE 将 ROM 区 域 的 程序 复制 到 RAM 区 
13 MFINTVL 维修 预报 数据 的 时 间 间 隔 
14 | MFREPO 维修 预报 数据 的 通知 方法 
15 MFGRST 维修 预报 数据 的 复位 
16 MFBRST 维修 预报 数据 的 复位 
17 DJNT 位 置 回归 相关 数据 
18 MEXDTL 位 置 回归 相关 数据 
19 MEXDTL1~5 | 位 置 回归 相关 数据 
20 MEXDBS 位 置 回归 相关 数据 
21 | TBOP 是 否 可 以 通过 示 教 单元 进行 程序 启动 


17.1.2 操作 参数 详解 
操作 参数 详解 见 表 17-2 一 表 17-18。 


表 17-2 BZR 
类 型 参数 符号 参数 名 称 功 能 
操作 BZR 报警 时 蜂 鸣 器 音响 OFF/ON 设置 报警 时 蜂 鸣 器 音响 
设置 OFF=00N=1 


表 17-3 PRSTENA 
类 型 参数 符号 参数 名 称 


功 能 


操作 PRSTENA 程序 复位 操作 权 程序 复位 操作 ”是 否 需 要 操 


必要 一 0, 不 要 =1, 出 厂 值 0( 必 要 )。 


设置 如 果 设 置 为 不 要 操作 权 ,就 可 在 任何 位 置 使 程序 复位 ,有 安全 上 的 危险 。 特 别 是 不 能 在 示 教 
单元 上 使 程序 复位 
G = ~ 
翅 娄 名: PRSTENA 机 :0 
WH :Operation nght for program reset (need/not need=0/1) 
#1Ep(P) 
表 17-4 MDRST 
类 型 参数 符号 参数 名 称 功 能 
操作 MDRST 随 模 式 转 换 进行 程序 复位 随 模 式 转 换 进 行程 序 复位 
设置 无 效 = 二 0, 有 效 二 1, 出 厂 值 0( 无 效 ) 


者 数 名 : MDRST 机 器 号: 0 
说明 : program reset with Mode change (1:ON, 0:OFF) 


#0(P) [sxw (CO) | 
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表 17-5 OPDISP 


类 型 参数 符号 参数 名 称 功 能 
操作 OPDISP 操作 面板 显示 模式 设置 模式 切换 时 的 显示 内 容 
设置 OPDISP 一 0, 显 示 速 度 倍率 ; OPDISP 一 1, 显 示 原 内 容 

参数 名 : OPDISP 机 器 号 : 0 
说 明 : OP display at the time ofa mode change(OVRD/KEEP=0/1) 
pp) Ho 
表 17-6 OPPSL 

类 型 参数 符号 参数 名 称 功 能 

操作 ee 操作 面板 上 已 经 选择 AUTO 模 | 操作 面板 为 AUTO 模式 时 的 程序 选 
式 时 的 程序 选择 操作 权 择 操作 权 
设置 OPPSL=0, 外 部 信号 ( 指 来 自 外 部 1/O 的 信号 ); OPPSL=1,OP 操作 面板 
基数 名 : OPPSL 机 器 号 : 0 
说 明 : program select AUTO(OP) mode (Ext/OP=0/1) 
可 
ED m6 
表 17-7 RMTPSL 
类 型 参数 符号 参数 名 称 功 能 
AUTO 模式 时 的 程序 选择 操 | 由 外 部 信号 选择 AUTO 模式 时 的 程 

i | 作 权 序 选择 操作 权 
设置 外 部 = 二 0,OP=1, 出 厂 值 0( 外 部 ) 


参数 名 : RMTPSL 机 器 号 : 0 
说 明 : program select AUTO(Ext) mode (Ext/JOP=0/1) 


ed 


表 17-8 OVRDTB 


类 型 参数 符号 参数 名 称 功 能 
示 教 单元 上 改变 速度 倍率 的 操 | 设置 示 教 单元 上 改变 速度 倍率 的 操 
| 作 权 选择 作 权 选择 
设置 不 必要 ==0, 必 要 ==1, 出 厂 值 1 
孝 数 名 : OVRDTB 机 器 号 : 0 
WH : Operation right for OVRD from TB(not need/ need=0/1) 
表 17-9 OVRDMD 
类 型 参数 符号 参数 名 称 功 能 
在 示 教 模式 变更 为 自动 模式 、 自 动 模 
操作 OVRDMD 模式 变更 时 的 速度 设 定 式 变更 为 示 教 模式 时 自动 设置 的 速 
度 倍率 
第 1 栏 : 在 示 教 模式 变更 为 自动 模式 时 自动 设置 的 速度 倍率 ; 
设置 第 2 栏 : 在 自动 模式 变更 为 示 教 模式 时 自动 设置 的 速度 倍率 。 
设置 数据 一 0, 保 持原 来 的 速度 倍率 
驮 数 名 : OVRDMD 机 器 号 : 0 
说 明 ; OVRD after change MODE(TEACH->AUTO,AUTO->TEACH) 
表 17-10 OVRDENA 
类 型 参数 符号 参数 名 称 功 能 
操作 OVRDENA 改变 速度 倍率 的 操作 权 设置 改变 速度 倍率 是 否 需要 操作 权 
设置 必要 二 0, 不 必要 二 1; 出 厂 值 0( 必 要 ) 


戎 教 名 : OVRDENA 机 如 号 : 0 
WM : Operation right for OVRD change (need/not need=0/1) 


#7Eph(P) SA(W) ] 关 ia(O 
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表 17-11 ROMDRV 


类 型 参数 符号 参数 名 称 功 能 
操作 | ROMDRV 切换 程序 的 存 取 区 域 tie A NA 
0 二 RAM 模式 (初始 值 使 用 SRAM) 
宙 重 1 一 ROM 模式 
2 一 高 速 RAM 模式 (使 用 DRAM) 
出 厂 值 =2 
者 数 名 : ROMDRV 机 器 号 : 0 
WM : Drve-mode change (0:RAM / 2:DRAM) 
打 Ep(P) 
表 17-12 BACKUP 
类 型 参数 符号 参数 名 称 功 能 
将 RAM 区 域 的 程序 复制 到 | 将 程序 ,参数 \ 共 变量 从 RAM 区 域 复 
| ROM 区 制 到 ROM 区 
设置 
表 17-13 RESTORE 
类 型 参数 符号 参数 名 称 功 能 
将 ROM 区 域 的 程序 复制 到 | 将 程序 参数 、 共 变量 从 ROM 区 域 复 
操作 RAM 区 制 到 RAM 区 
设置 FLROM—SRAM 


表 17-14 MFINTVL 


类 型 参数 符号 参数 名 称 功 能 
操作 MFINTVL 维修 预报 数据 的 时 间 间 隔 设置 维修 预报 数据 的 时 间 间 隔 
设置 第 1 栏 : 采样 量 级 (1 一 5 小 时 ); 

第 2 栏 : 维修 预报 数据 的 时 间 间 隔 (1 一 24 小 时 ) 
基数 名 : MFINTVL 机 器 号 : 1 
说 明 : Samping level(1-5) and forecast ntervak1-24 Hr) 
表 17-15 MFREPO 

类 型 参数 符号 参数 名 称 功 能 
操作 MFREPO 维修 预报 数据 的 通知 方法 
设置 第 1 栏 : 发 出 报警 =1, 不 发 出 报警 =0 

第 2 栏 : 专用 信号 输出 =1, 专 用 信号 不 输出 =0 
参数 名 : MFREPO 机 器 号 : 1 
说 明 : Waming generation and sgnal output for M.F.(effectve=1/nvaldty=0) 
表 17-16 MFGRST 

类 型 参数 符号 参数 名 称 功 能 
操作 MFGRST 维修 预报 数据 的 复位 将 润滑 油 数据 复位 

0 一 全 部 轴 复 位 

Bi 1 一 8 一 指定 轴 复 位 

表 17-17 MFBRST 

类 型 参数 符号 参数 名 称 功 能 
操作 MFBRST 维修 预报 数据 的 复位 将 皮带 数据 复位 
0 一 全 部 轴 复 位 
设置 。 | 1 一 8 一 指定 轴 复 位 
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表 17-18 TBOP 
类 型 | 参数 符号 参数 名 称 功 能 


操作 | TBOP 是 否 可 以 通过 示 教 单元 进行 程序 启动 | 设置 是 否 可 以 通过 示 教 单元 进行 程序 启动 


设置 0 一 不 可 以 ,1 一 可 以 


参数 名 : TBOP 机 器 号 : 0 
说 明 : program start operation by TB. (0:Disable, 1:Enable) 


17.2 网 络 通信 参数 


17.2.1 通信 及 现场 网 络 参 数 一 览 表 


如 表 17-19 所 示 是 通信 及 现场 网 络 参数 一 览 表 。 
表 17-19 通信 及 现场 网 络 参数 一 览 表 


序号 参数 符号 参数 名 称 参数 功能 
| COMSPEC RT TooLBox2 通信 方式 | 选择 控制 器 与 RT TooLBox2 软件 的 通信 模式 
2 COMDEV 通信 端口 分 配 设置 
3 NETIP 控制 器 的 IP 地 址 192. 168. 0. 20 
4 NETMSK 子 网 掩 码 255. 255. 255. 0 
5 NETPORT 端口 号 码 三 


17.2.2 通信 及 网 络 和 参数 详解 


通信 及 网 络 参 数 详解 见 表 17-20 一 表 17-21 。 
表 17-20 RS-232 通信 参数 
类 型 参数 符号 参数 名 称 功 能 


通信 RS-232 通信 参数 


设置 如 下 图 所 示 。 


类 型 参数 符号 


表 17-21 以 太 网 参数 
参数 名 称 


通信 


以 太 网 参数 


设置 如 下 图 所 示 。 


| 设备 分 R(A): (COMDEV) 


设备 。 模式 
OPTI1 1: 服务 器 
OPT12 1; 服务 器 


OPT15 1: 服务 器 
OPT16 1: 服务 器 
OPT17 1: 服务 器 
OPTI18 1 服务 器 


了 地 址 
192.168.0.2 
192.168.0.3 
192.168.0.4 
192.168.0.5 
192.168.0.6 
192.168.0.7 
192.168.0.8 


10002 0: 无 上 名 0: 无 0: CR 
10003 0: 无 步 叶 0: 无 0: CR 
10004 0: 无 上 对 0: 无 。 0: 
10005 0 无 步 枯 0: 无 。 0: CR 
10006 0: 无 步 潮 0 无 。 0: 
10007 0: 无 步 滁 0: 无 。 0:0 

:无 步 于 0: 无 0: 


COM1: RS232 ~ 
COM2; (未 选 振 ) 
COM3: (过 笃 ) 
COM4: (未 寺 笃 ) 
COMS: (二 和 笃 ) 
COM6: (不 选择) 
COM7: (未 造 所 ) 
COM8: (未 这 掺 ) 


44 4 


[ige(s).. | 


17.3 需要 思考 的 问题 


(1) 操作 型 参数 主要 包含 哪些 方面 的 内 容 ? 
(2) 通信 型 参数 主要 包含 哪些 方面 的 内 容 ? 
(3) 如 何 设置 程序 复位 操作 权 ? 
(4) 如 何 设置 RS-232 通信 参数 ? 
(5) 如 何 设 置 以 太 网 通信 参数 ? 
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【学 习 目 的 】 
本 章 学 习 通过 参数 来 设置 “输入 输出 端子 ”的 功能 。 


18.1..1 


第 18 日 一 一 参数 的 功能 及 设置 (3) 


18.1 


如 表 18-1 所 示 是 专用 输入 输出 信号 一 览 表 。 


输入 输出 信号 参数 


专用 输入 输出 信号 参数 一 览 表 


表 18-1 专用 输入 输出 信号 一 览 表 
序号 | 参数 类 型 参数 符号 参数 名 称 参数 功能 
1 AUTOENA 可 自动 运行 “自动 使 能 ”信号 
3 es 疝 涝 程序 启动 信号 。 在 多 任务 时 ,启动 全 
部 任务 区 内 的 程序 
停止 程序 执行 。 在 多 任务 时 ,停止 全 
3 Stop 停止 部 任务 区 内 的 程序 。STOP 信号 地 址 
是 固定 的 
功能 与 STOP 信号 相同 。 但 输入 信 
4 STOP2 停止 号 地 址 可 改变 
输入 解除 程序 中 断 状态 ,返回 程序 起 始 
Se i 行 。 对 于 多 任务 区 ,指令 所 有 任务 区 
和 i a 内 的 程序 复位 。 但 对 以 ALWAYS 或 
ERROR 为 启动 条 件 的 程序 除外 
6 Errrset 报错 复位 解除 报警 状态 
7 Cycle 单 (循环 ) 运 行 选择 停止 “程序 连续 循环 ”运行 
8 Srvoff 伺服 OFF 指令 全 部 机 器 人 伺服 电源 一 OFF 
9 Srvon 伺服 ON 指令 全 部 机 器 人 伺服 电源 = 二 ON 
10 IOENA 操作 权 外 部 信号 操作 有 效 
a “ 回 退 避 点 ”启动 信号 。 
11 |SAFEPOS | 回 退 避 点 退 避 点 由 参数 设置 
“输出 信号 复位 ”指令 
12 |OUTRESET | 输出 信号 复位 信和 号。 复位 方式 由 参 


数 设置 


续 表 


序号 | 参数 类 型 参数 符号 参数 名 称 参数 功能 
程序 运动 ,机 器 人 机 械 
13 |MELOCK || 机械 锁定 不 动作 
14 PRGSEL 选择 程序 号 用 于 确认 已 经 选择 的 程序 号 
15 OVRDSEL 选择 速度 倍率 用 于 确认 已 经 选择 的 程序 倍率 
16 PRGOUT 请 求 输出 程序 号 请 求 输出 程序 号 
17 LINEOUT 请 求 输出 程序 行 号 “| 请 求 输出 程序 行 号 
18 ERROUT 请 求 输出 报警 号 请 求 输出 报警 号 
19 TMPOUT Ee 加 册 鬼 机 息 沟 请 求 输出 控制 柜 内 温度 
用 一 组 输入 信号 端子 表示 选择 的 程 
20 IODATA 数据 输入 信号 端 地 址 | 序号 或 速度 倍率 (8421 码 ) 
表示 输出 状态 也 是 同样 方法 
21 由 OGENA 选择 JOG 运行 模式 JQGPNA 0; 光 禾 
y J JOGENA= 1, 有 效 
选择 JOG 运行 的 坐 |JOGM = 0/1/2/3/4 关节 / 直 交 / 圆 
加 J 标 系 简 /三 轴 直 交 / 工 具 
5 Fs 2 
23 JOG 十 JOG 十 指令 信号 人 合作 王 的 癌 晶 / 结 训 起 相合 和 
辣 Ye JS II 
25 JOGNER JOG 运行 时 不 报警 os 肖 和 村 用 信用 才 了 由 不 关 
品 各 任务 区 程序 启动 信 | 设 置 各 任务 区 程序 启 
号 ( 共 32 区) 动 信号 地 址 
各 任务 区 程序 停止 信 | ， 
27 SnSTOP 对 ( 共 32 区 ) 设置 各 任务 区 程序 停止 信号 地 址 
28 |SnSTART |SnSRVON 各 机 器 人 伺服 ON 设置 各 机 器 人 伺服 ON 
29 SnSRVOFF 各 机 器 人 伺服 OFF “| 设置 各 机 器 人 伺服 OFF 
30 SnMELOCK (各 机 器 人 ) 机 械 锁 定 | 设置 (各 机 器 人 ) 机 械 锁 定 信号 
31 MnWUPENA ee 设置 各 机 器 人 预 热 运行 模式 


18.1.2 专用 输入 输出 信号 详解 


本 节 投 述 机 器 人 系统 所 具备 的 (内 置 )“ 输 入 “输出 ”功能 ,通过 参数 可 将 这 些 功 能 设置 
到 “输入 输出 端子 ”。 在 没有 进行 参数 设置 前 ,1/O 卡 上 的 “输入 输出 端子 ”是 没有 功能 定义 


的 ,就 像 一 台 空白 的 PLC 控制 器 一 样 。 


1. 通用 输入 输出 1 
为 了 便于 阅读 和 使 用 ,将 输入 输出 信号 单独 列 出 。 在 机 器 人 系统 中 ,专用 输入 输出 的 
(功能 )“ 名 称 ( 英 文 )” 是 一 样 的 , 即 同一 “名 称 (英文 )” 可 能 表示 输入 也 可 能 表示 输出 ,初学 者 
刚 开始 阅读 指令 手册 时 会 感到 困惑 ,本 书 将 输入 输出 信号 单独 列 出 ,便于 读者 阅读 和 使 用 。 
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表 18-2 是 输入 信号 功能 一 览 表 1, 这 一 部 分 信号 是 经 常 使 用 的 。 
表 18-2 输入 信号 功能 一 览 表 1 


类 型 参数 符号 参数 名 称 功 能 
AUTOENA 可 自动 运行 “自动 使 能 ”信号 
Start 启动 程序 启动 信号 。 在 多 任务 时 ,启动 全 部 任务 区 内 的 程序 
停止 停止 程序 执行 。 在 多 任务 时 ,停止 全 部 任务 区 内 的 程 
i 序 。Stop 信号 地 址 是 固定 的 
Stop2 停止 功能 与 Stop 信号 相同 ,但 输入 信号 地 址 可 改变 
解除 程序 中 断 状态 ,返回 程序 起 始 行 。 对 于 多 任务 区 ， 
输入 | Slotinit 程序 复位 指令 所 有 任务 区 内 的 程序 复位 。 但 对 以 ALWAYS 或 
ERROR 为 启动 条 件 的 程序 除外 
Errrset 报错 复位 解除 报警 状态 
Cycle 单 (循环 ) 运 行 ”| 选择 停止 “程序 连续 循环 ”运行 
Srvoff 伺服 OFF 指令 全 部 机 器 人 伺服 电源 二 OFF 
Srvon 伺服 ON 指令 全 部 机 器 人 伺服 电源 二 ON 
IOENA 操作 权 外 部 信号 操作 有 效 
设置 “| 参见 图 18-1 
WM WR 
eB [aramA| | [BE [AOA 
启动 START 3 运行 中 START 0 
层 - 一 一 皮 : FS 
Je [or 民生 一 一 二 
”| 信 止 输入 中 StopsTs 
本 本 SLOTINIT 可 以 选择 程序 SLOTINIT 
报 措 夏 位 ERRRESET ”2 。 | 报警 发 生 中 ERRRESET 2 
几时 一 一 cae [lt 中 cae 
伺服 OFF SRVOFF 1 | 伺服 ON 不 可 SRVOFF 
何 腿 oON SRVON 4 [ 何 卫 on 中 RON 1 
贰 一 一 一 IO6A 5 | 操作 权 IONA 3 


图 18-1 通用 输入 输出 1 相关 参数 的 设置 


(1) AUTOENA 一 一 “自动 使 能 ”信号 。AUTOENA = 1 允许 选择 自动 模式 。 
AUTOENA=0 不 允许 选择 自动 模式 ,选择 自动 模式 则 报警 (L5010)。 但 是 如 果 不 分 配 输 
入 端子 信号 则 不 报警 ,所 以 一 般 不 设置 AUTOENA 信和 号。 

(2) Cycle 一 一 Cycle 二 ON ,程序 只 执行 一 次 (执行 到 END 即 停止 ) 。 

(3) 伺服 ON 信号 在 “自动 模式 下 ” 才 有 效 ,选择 手动 模式 时 无 效 。 

(4) Stop 一 一 是 一 种 暂停 。Stop 二 ON ,程序 停止 。 重 新 发 Start 信号 ,程序 从 断 点 启 
动 。Stop 信号 固定 分 配 到 “输入 信号 端子 0”。 除 了 Stop 信号 ,其 他 输入 信号 地 址 可 以 任意 
设置 修改 。 例 如 ,Start 信号 可 以 从 出 厂 值 *3” 改 为 *31”。 

2. 通用 输入 输出 2 

表 18-3 是 输入 信号 功能 一 览 表 2。 由 于 在 RT 软件 设置 界面 上 是 同一 界面 ,所 以 将 这 
些 信号 归 为 一 类 。 


表 18-3 输入 信号 功能 一 览 表 2 


类 型 参数 符号 参数 名 称 功 能 
加 “ 回 退 避 点 ”启动 信号 
动作 SAFEPOS 回 退 避 点 退 避 点 由 参数 设置 
a “输出 信号 复位 ?指令 信号 。 复 位 方 
OUTRESET 输出 信号 复位 式 由 参数 设置 
MELOCK | 机 械 锁 定 程序 运动 ,机 器 人 机 械 不 动 
设置 参见 图 18-2 


mh WE 
[EE spos | ”| [ 沪 注 点 夏 位 中 SAFEPOS 
| 通用 输出 信号 复位 [oureser 
机 可 锁定 MELOCK 机 器 说 定 中 Mao | 
H- 级 别 报警 HLVLERR. 
-级 别 报警 LLVLERR 
Caution( 革 各 ) QERR 
紧急 停止 EMGERR 
示 教 模式 中 下 
自动 模式 中 ATTOPWD 
运程 模式 中 


图 18-2 通用 输入 输出 2 相关 参数 的 设置 


3. 数据 参数 
表 18-4 是 输入 信号 功能 一 览 表 3。 由 于 在 RT 软件 设置 界面 上 是 同一 界面 ,所 以 将 这 
些 信号 归 为 一 类 。 


表 18-4 输入 信号 功能 一 览 表 3 


类 型 参数 符号 参数 名 称 功 能 

信号 PRGSEL 选择 程序 号 用 于 确认 输入 的 数据 为 程序 号 
OVRDSEL 选择 速度 倍率 用 于 确认 输入 的 数据 为 程序 倍率 
PRGOUT 请 求 输出 程序 号 请 求 输出 程序 号 
LINEOUT 请 求 输出 程序 行 号 请 求 输出 程序 行 号 
ERROUT 请 求 输出 报警 号 请 求 输出 报警 号 
TMPOUT 请 求 输出 控制 柜 内 温度 | 请 求 输出 控制 柜 内 温度 

用 一 组 输入 信号 端子 (8421 码 ) 作 为 输入 数据 用 

IODATA 数据 输入 信号 端 地 址 表示 输出 数据 也 是 同样 方法 

设置 参见 图 18-3 


PRGSEL 一 一 程序 选择 确认 信号 。 当 通过 IODATA 指定 的 输入 端子 (构成 8421 码 ) 选 
择 程序 号 后 ,将 PRGSEL 王 ON , 即 确认 了 输入 的 数据 为 程序 号 。 
4. JOG 运行 信号 
这 是 不 用 示 教 单元 而 用 外 部 信和 号 实现 JOG 运行 的 输入 输出 端子 设置 参数 。 
表 18-5 是 JOG 运行 输入 信号 功能 一 览 表 。 由 于 在 RT 软件 设置 界面 上 是 同一 界面 ,所 | 第 


18 
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图 18-3 数据 参数 的 设置 


表 18-5 JOG 运行 输入 信号 功能 一 览 表 


类 型 参数 符号 参数 名 称 功 能 

信号 JOGENA 选择 JOG 运行 模式 JOGENA 一 0, 无效; JOGENA= 二 1, 有 效 

och 选择 JOG 运行 的 坐标 系 JOGM= 0O/1/2/3/4, 关 节 / 直 交 / 圆 简 / 三 轴 直 
交 / 工 具 

JOG 十 JOG 十 指令 信号 设置 指令 信号 的 起 始 / 结 束 地 址 信号 (8 轴 ) 
JOG 一 JOG 一 指令 信号 设置 指令 信号 的 起 始 / 结 束 地 址 信号 (8 轴 ) 
JOGNER JOG 运行 时 不 报警 在 JOG 运行 时 即使 有 报警 也 不 发 报警 信号 

设置 


执行 外 部 信号 做 JOG 运动 的 方法 如 下 。 

(1) 选择 “自动 模式 "(只 有 在 自动 模式 下 ,伺服 ON 才 有 效 )。 

(2) 发 “伺服 ON”==1 信号。 

(3) 使 JOGENA== 1( 在 图 18-4 中 为 输入 端子 16) (在 图 18-4 中 输入 端子 24 一 29 为 
有 一 J6 的 JOG 十 信号 ) ,发 出 各 轴 JOG 十 信号 ,各 轴 做 JOG 动作 。 


5. 各 任务 区 启动 信号 


图 18-4 JOG 运行 相关 参数 的 设置 


各 任务 区 启动 信号 如 表 18-6 所 示 。 


表 18-6 各 任务 区 启动 信号 


类 型 参数 符号 参数 名 称 功 能 
SnSTART 各 任务 区 程序 启动 信号 ( 共 32 区 ) | 设置 各 任务 区 程序 启动 信号 地 址 
设置 参见 下 图 


I 


3 


6. 各 任务 区 停止 信号 
各 任务 区 停止 信号 如 表 18-7 所 示 。 


表 18-7 各 任务 区 停止 信号 


类 型 参数 符号 参数 名 称 功 能 
SnSTOP 各 任务 区 程序 停止 信号 ( 共 32 区 ) | 设置 各 任务 区 程序 停止 信号 地 址 
设置 见 下 图 


7. 各 机 器 人 伺服 ON/OFF 
各 机 器 人 伺服 ON/OFF 如 表 18-8 所 示 。 


表 18-8 各 机 器 人 伺服 ON/OFF 


类 型 参数 符号 参数 名 称 功 能 
SnSRVON 各 机 器 人 伺服 ON 设置 各 机 器 人 伺服 ON 
SnSRVOFF 各 机 器 人 伺服 OFF 设置 各 机 器 人 伺服 OFF 第 
设置 参见 下 图 ,N=1~3 18 
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续 表 
8. 各 机 器 人 机 械 锁 定 
各 机 器 人 机 械 锁定 如 表 18-9 所 示 。 
表 18-9 各 机 器 人 机 械 锁 定 
类 型 参数 符号 参数 名 称 功 能 
SnMELOCK 各 机 器 人 机 械 锁 定 设置 各 机 器 人 机 械 锁定 信和 号 
设置 参见 下 图 ,N=1~3 
9. 选择 各 机 器 人 预 热 运行 模式 
各 机 器 人 预 热 运行 模式 如 表 18-10 所 示 。 
表 18-10 各 机 器 人 预 热 运行 模式 
类 型 参数 符号 参数 名 称 功 能 
MnWUPENA 各 机 器 人 预 热 运行 模式 选择 设置 各 机 器 人 预 热 运行 模式 
设置 必须 预先 设置 参数 WUPENA ,选择 预 热 模式 有 效 。 本 参数 只 是 对 各 机 器 人 的 选择 
输入 信号 输出 信号 
睡 机 运行 模式 设 定 (5) 星 机 运行 模式 
[EEC [aetr[mwuaw 
胜 机 运行 杖 态 (6) 
[Re 


10. 附加 轴 

附加 轴 指 机 器 人 外 围 设备 中 的 由 伺服 系统 驱动 的 运动 轴 。 为 了 使 其 配合 机 器 人 的 动 
作 , 可 以 从 机 器 人 控制 器 一 侧 对 其 进行 控制 ,如 图 18-5 和 表 18-11 一 表 18-17 所 示 。 

图 18-5 是 对 附加 轴 参 数 进行 设置 的 界面 。 


SC 


多 重 机 器 使 用 台数 (N) (AXUNUM) | 


18-5 ”附加 轴 相 关 参 数 设置 界面 


表 18-11 AXMENO 一 一 控制 附加 轴 的 “机 器 人 号 ” 


类 型 参数 符号 参数 名 称 功 能 
AXMENO 控制 附加 轴 的 “机 器 人 号 ” 设置 控制 附加 轴 的 机 器 人 编号 
设置 如 下 图 
表 18-12 AXJNO 一 一 附加 轴 的 “驱动 器 站 号 ” 
类 型 参数 符号 参数 名 称 功 能 
AXJNO 附加 轴 的 “驱动 器 站 号 ” 设置 附加 轴 的 驱动 器 站 号 
设置 如 下 图 ,在 附加 轴 连 接 完毕 后 ,要 设置 每 一 驱动 器 的 “站 号 ”。 在 通用 伺服 系统 中 也 是 要 设置 


站 号 的 


第 
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表 18-13 AXUNT 一 一 附加 轴 使 用 的 单位 (deg/mm) 


类 型 参数 符号 参数 名 称 功 能 
AXUNT 附加 轴 使 用 单位 (deg/mm) 设置 附加 轴 使 用 单位 (deg/mm) 
设 和 如 下 图 ,设置 附加 轴 使 用 单位 
AXUNT=0,deg; AXUNT=1,mm 
者 教 名 : AXUNT 机 :0 
WM : Unt for additional axs (deg/mm = 0/1) 
20 5:0 9: 0 13:0 
2:0 6:0 10:0 14: 0 
3:0 7:0 11:0 15:0 
4:0 8:0 12: 0 16:0 
表 18-14 AXSPOL 一 一 附加 轴 旋 转 方向 
类 型 参数 符号 参数 名 称 功 能 
AXSPOL 附加 轴 旋 转 方 向 确定 附加 轴 旋 转 方向 
设置 如 下 图 。AXSPOL=0,CCW; AXSPOL=0,CW 
赤 数 名 : AXSPOL 机 器 吕 : 0 
说 明 : Round drection of additional axis (CCW/CW = 0/1) 
表 18-15 AXACC 一 一 附加 轴 加 速 时 间 
类 型 参数 符号 参数 名 称 功 能 
AXACC 附加 轴 加 速 时 间 设置 附加 轴 加 速 时 间 
设置 如 下 图 ,设置 单位 为 sec 


参数 名 : AXACC 机 器 号: 0 
说 明 : Acceleration time for addiional ax [sec] 


:hb.2000 


9: 0.2000 


: 0.2000 


10: 0.2000 


: 0.2000 


11: 0.2000 


: 0.2000 


12: 0.2000 


Eh() 


表 18-16 AXDEC 一 一 附加 轴 减 速 时 间 
类 型 参数 符号 参数 名 称 功 能 


AXDEC 附加 轴 减 速 时 间 设置 附加 轴 减 速 时 间 


设置 如 下 图 ,设置 单位 为 sec 


塘 数 名 : AXDEC 机 器 号 : 0 
说 明 : Deceleration time for addiional axis [sec] 


表 18-17 AXGRTN 一 一 附加 轴 齿 轮 比分 子 


类 型 参数 符号 参数 名 称 功 能 
AXGRTN 附加 轴 齿 轮 比分 子 设置 附加 轴 齿 轮 比分 子 
设置 如 下 图 


基 雪 名 : AXGRTN 机 器 号 : 0 
说 明 : Numerator of gear ratio for additional axis 


18.2 如何 监视 输入 输出 信号 


1. 通用 信号 的 监视 和 强制 输入 输出 

功能 : 用 于 监视 输入 输出 信号 的 ON/OFF 状态 。 

单 击 “ 监 视 ”>“ 信 号 监视 ”一 “通用 信和 号”, 弹出 “通用 信号 ” 框 ,如 图 18-6 所 示 。 在 “通用 
信和 号? 框 内 除了 监视 当前 输入 输出 信号 的 ON/OFF 状态 以 外 ,还 可 以 : 

(1) 模拟 输入 信号 ; 

(2) 设置 监视 信号 的 范围 ; 

(3) 强制 输出 信号 ON/OFF。 

2. 对 已 经 命名 的 输入 输出 信号 监视 

功能 : 用 于 监视 已 经 命名 的 输入 输出 信号 的 ON/OFF 状态 。 

单 击 “ 监 视 ”>“ 信 号 监视 ”>“ 带 名 字 的 信号 ”, 弹 出“ 带 名 字 的 信和 号” 框 ,如 图 18-7 所 示 。 | 第 
在 “ 带 名 字 的 信号 " 框 内 可 以 监视 已 经 命名 的 输入 输出 信号 的 ON/OFF 状态 。 18 
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18-6 “通用 信和 号” 框 的 监视 状态 


图 18-7 “ 带 名 字 的 信号 ” 框 内 监视 已 经 命名 的 输入 输出 信号 的 ON/OFF 状态 


18.3 需要 思考 的 问题 


(1) 机 器 人 系统 是 否 具备 内 置 的 输入 输出 功能 ? 

(2) 外 接 I/O 卡 上 的 端子 未 加 定义 之 前 ,是 不 是 空白 的 1/O 端子 ? 
(3) 如 何 定义 各 输入 输出 端子 的 功能 ? 

(4) 什么 是 单 循环 运行 ? 如 何 设 置 单 循环 运行 信号 ? 

(5) 可 以 通过 外 部 W/O 端子 实现 JOG 运行 吗 ? 

(6) 什么 是 机 械 锁定 功能 ? 如 何 设置 机 械 锁 定 功 能 ? 


第 19 章 第 19 日 一 一 使 用 外 部 信号 选择 程序 


【学 习 目 的 】 
机 器 人 系统 内 可 预先 存放 很 多 程序 ,要 运行 某 一 个 程序 ,可 以 进行 选择 。 选 择 程 序 的 方 
法 有 多 种 ,本 章 结 合 第 18 章 的 内 容 , 学 习 仅 使 用 外 部 端子 实现 选择 程序 的 方法 。 


19.1 第 一 种 方法 : 先 选择 程序 号 再 启动 程序 


操作 步骤 如 下 。 

1. 相关 参数 设置 

(1) 设置 参数 PST =0, 如 图 19-1 所 示 。 

PST 是 程序 选择 模式 。 
PST=0, 先 选择 程序 号 再 启动 ; 

PST=1, 同 时 发 出 “选择 程序 "与 “程序 启动 信号。 


参数 名 : PST 机 器 吕 : 0 
说 明 : prog. No. read starting (1:Enable,0:Disable) 


图 19-1 设置 参数 PST 


(2) 需要 处 理 分 配 下 列 输入 输出 信号 。 
将 输入 输出 功能 分 配 到 下 列 端子 ,如 表 19-1 所 示 。 
表 19-1 需要 使 用 的 输入 输出 功能 及 端子 分 配 


参数 | 对 应 输入 输出 信号 功 能 输入 端子 | 输出 端子 

IOENA ”| 操作 权 设置 外 部 1/O 信号 有 效 5 3 
将 任务 区 内 的 “程序 号 "输出 到 外 部 端子 ,用 于 

eid i 检查 是 否 与 选择 的 “程序 号 "相符 和 


设置 用 以 输入 数据 的 端子 “起 始 号 "及 “结束 号 ” 


这 些 端子 构成 的 8421 码 即 选择 的 “程序 号 ” | “1 | 5 1 


IODATA | 数据 输入 端子 范围 


用 于 确定 “已 经 选 和 


RGSEL 
PRGSEL | 择 的 程序 号 * 


START 启动 3 


30 日 学 赚 工业 胡 器 人 


将 以 上 参数 功能 分 配 到 对 应 的 “输入 信号 端子 ”。 
(3) 在 RT ToolBox 软件 上 的 具体 设置 如 图 19-2 和 图 19-3 所 示 。 


5 WED 

可 自动 行 [oroaa 
启动 START 3 
停止 STOP 0 
停止 (STOPD) STOP2 


程序 复位 SLOTINIT 

报错 复位 ERRRESET l 
i 
伺服 OFF SRVOFF 1 
伺服 ON SRVON 4 
操作 权 IOENA 5 


确认 输入 的 
数据 为 程序 
号 的 端子 


输入 程序 
号 的 端子 


2. 操作 

(1) 指令 IOENA==1( 输 入 信号 5 二 ON) ,使 外 部 操作 信号 有 效 。 

(2) 选择 程序 号 : 以 端子 8 一 11 构成 的 8421 码 选择 程序 号 。 示 例如 表 19-2 一 表 19-4 所 示 。 
表 19-2 选择 3 号 程序 


图 19-3 设置 输入 输出 信号 端子 


端子 11 端子 10 端子 9 端子 8 
0 0 1 1 
表 19-3 选择 7 号 程序 
端子 11 端子 10 端子 9 端子 8 
0 和 1 1 


表 19-4 选择 12 号 程序 
端子 11 端子 10 端子 9 端子 8 


1 0 0 


3. 确认 已 经 选择 的 程序 号 有 效 
(1) 操作 PRESEL 端子 (输入 端子 6) 二 ON, 其 功能 是 确认 已 经 选择 的 程序 号 生效 。 
(2) 操作 PRGOUT 端子 (输入 端子 7) 二 ON。 


观察 输出 端子 8 一 11 构成 的 程序 号 是 否 与 选 定 的 程序 号 相同 ,如 果 相 同 可 以 执行 “启动 ”。 


4. 发 出 “启动 "信号 
启动 已 经 选择 的 程序 。 
操作 信号 时 序 图 如 图 19-4 所 示 。 
< 输入 > 
操作 权 输 入 IOENA 
数值 输入 IODATA 
程序 选择 PRGSEL 
和 输出 程序 号 请 求 PRGOUT 


启动 START 

< 输出 > 
操作 权 输 出 IOENA 
数值 输出 IODATA 


程序 执行 


图 19-4 ”操作 信号 时 序 图 


19.2 第 二 种 方法 :“ 选 择 程 序号 ”与 
“启动 ”信号 同时 生效 


这 种 方法 比较 快捷 ,但 是 必须 在 保证 程序 号 正确 的 情况 下 进行 。 
操作 步骤 如 下 。 
(1) 设置 参数 PST =1。 
PST=1:“ 选 择 程序 与 “程序 启动 ”同时 生效 。 
(2) 操作 : 指令 IOENA==1( 输 入 信号 5==ON)。 
使 外 部 操作 信号 有 效 。 
(3) 选择 程序 : 以 端子 8 一 11 构成 的 8421 码 选择 程序 号 。 示 例如 表 19-5 所 示 。 
表 19-5 选择 12 号 程序 
端子 11 端子 10 端子 9 端子 8 


1 1 0 0 
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(4) 发 出 “启动 ”信号 


启动 已 经 选择 的 程序 。 
操作 信号 时 序 图 如 图 19-5 所 示 。 
< 输入 > 
操作 权 输 入 IOENA 
数值 输入 lODATA 
启动 START 
< 输出 > 
操作 权 输 出 。 IOENA 
程序 执行 


19-5 操作 信号 时 序 图 


19.3 需要 思考 的 问题 


(1) 机 器 人 系统 可 以 预 置 多 少 工作 程序 ? 

(2) 如 何 定义 输入 数据 端子 ? 输入 数据 端子 如 何 构成 数据 ? 

(3) 如 何 定义 输出 数据 端子 ? 怎样 读 取 输 出 数据 端子 构成 的 数据 ? 
(4) 怎样 确认 输入 的 数据 就 是 程序 号 ? 

(5) 哪 种 选择 程序 号 的 方法 更 安全 ? 


第 20 章 第 20 日 一 一 编程 语言 中 的 函数 


【学 习 目 的 】 

在 机 器 人 的 编程 言语 中 ,提供 了 大 量 的 运算 函数 ,这 样 就 大 大 提高 了 编程 的 便利 性 。 本 
童 将 详细 介绍 这 些 运 算 函 数 的 用 法 ,这些 运算 函数 按 英文 字母 顺序 排列 ,便于 学 习 和 查阅 。 
在 学 习 本 章 时 ,应 该 先 通读 一 遍 , 然 后 根据 编程 需要 ,重点 研读 需要 使 用 的 函数 。 


20. 1 Abs 一 一 求 绝对 值 


1. 功能 

Abs 为 求 绝对 值 函 数 。 

2. 格式 

< 数值 变量 > = Abs < 数 式 > 

3. 例句 

1 P2.C= hbs(P1.C) 一 一 将 Pl 点 C 轴 数据 求 绝对 值 后 赋予 P2 点 C 轴 。 
2 ”Mov P2' 一 一 前 进 到 P2 点 。 

3 ”M2 =- 100' 一 一 赋值 。 

4 ML = hbs(M2) ' 一 一 将 M2 求 绝对 值 后 赋值 到 M1。 


20.2 Asc 求 字符 串 的 ASCII 码 

1. 功能 

Asc 用 于 求 字 符 串 的 ASCII 码 。 

2. 格式 

< 数值 变量 > = Asc < 字符 串 > 

3. 例句 

M1=Asc("A")'—— M1 = &H41 

20.3 Atn/Atn2 一 一 余 切 函数 
1. 功能 


Atn/Atn2 为 余 切 函数 ,用 于 计算 余 切 。 
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2. 格式 


< 数值 变量 > = Atn < 数 式 > 
< 数值 变量 > = Atn2 < 数 式 1 >,< 数 式 2> 


3. 术语 解释 


< 数 式 > 一 一 AY/AX 
< 数 式 1 > 一 一 AY 
< 数 式 2> 一 一 AX 


4. 例句 


1 MIL = Rhtn(100/100) ' 一 一 ML =x/4 弧度 

2 M2 = htn2( - 100,100) 一 一 ML =- /4 弧度 
5. 说 明 

根据 数据 计算 余 切 ,单位 为 “弧度 ”。 

Atn 范围 在 一 xz/2 一 x/2。 

Atn2 范围 在 一 xz 一 r。 


20.4 ”CalArc 一 一 计算 圆 弧 数据 
1. 功能 
CalArc 用 于 当 指定 的 三 点 构成 一 段 圆 弧 时 , 求 出 圆 弧 的 半径 .中 心 角 和 圆 弧 长 度 。 
2. 格式 
< 数值 变量 4> = CalArc(< 位 置 1 >,< 位 置 2>, < 位置 3>,< 数 值 变 量 1 >, < 数值 变量 2 >, < 数值 变量 3 >, 
< 位 置 变量 1 >) 
3. 术语 解释 
< 位 置 1 > 一 一 区 
< 位 置 2 > 一 一 加 
< 位 置 3 > 一 一 风 


< 数值 变量 1 > 一 一 计算 得 到 的 “ 圆 弧 半径 (mm)”; 

< 数值 变量 2 > 一 一 计算 得 到 的 “ 圆 弧 中 心 角 (deg)”; 

< 数值 变量 3 > 一 一 计算 得 到 的 “ 圆 弧 长 度 (mm)”; 

< 位 置 变量 1 > 一 一 计算 得 到 的 * 圆 弧 中 心 坐 标 ( 位 置 型 ,ABC 一 0); 
< 数值 变量 4 > 一 一 函数 计算 值 : 

< 数值 变量 4>=1 可 正常 计算 ; 


< 数值 变量 4 > 一 一 1 一 一 给 定 的 两 点 为 同一 点 :或 三 点 在 同一 直线 上 ， 
< 数值 变量 4 > 一 一 2 一 一 给 定 的 三 点 为 同一 点 。 
4. 例句 


1 M1 = Calhrc(P1,P2,P3,M10,M20,M30,P10) ' 一 一 做 求 圆 弧 各 参数 计算 。 
2 If M1 <>1 Then End' 一 一 如 果 各 设 定 条 件 不 对 ,就 结束 程序 。 


MR= M10' 一 一 将 " 圆 弧 半径 "代入 MR。 

MRD = M20 一 一 将 " 圆 弧 中 心 角 " 代 入 MRD。 
MRRCLEN = M30' 一 一 将 " 圆 弧 长 度 " 代 入 MRRCLEN 。 
PC = P10' 一 一 将 " 圆 弧 中 心 点 坐标 "代入 PC。 


Ou 


20.5 ”CInt 一 一 将 数据 四 舍 五 入 后 取 整 


1. 功能 
CInt 用 于 将 数据 四 舍 五 人 后 取 整 。 
2. 格式 
< 数值 变量 > = CInt (< 数据 >) 
3. 例句 
1 Ml=CInt(1.5)'— M1 =2 
2 M2 = CInt(1.4) ' 一 一 M2 =1 
3 M3 = CInt( -1.4) 一 一 M3 =-1 
4 M4=CInt( -1.5)' 一 一 M4 =-2 
20.6 Cos 一 一 余弦 函数 
1. 功能 
Cos 为 余弦 函数 。 
2. 格式 
< 数值 变量 > = Cos (< 数据 >) 
3. 例句 
1 Ml=Cos(Rad(60))' 一 一 将 60 "的 余弦 值 代 入 M1。 
4. 说 明 


(1) 角度 单位 为 “弧度 ”。 
(2) 计算 结果 范围 一 1 一 1。 


20.7 Deg 将 角度 单位 从 弧度 (rad) 
变换 为 度 (deg) 
1. 功能 
Deg 用 于 将 角度 单位 从 弧度 (rad) 变 换 为 度 (deg)。 
2. 格式 第 
20 
< 数值 变量 > = Deg(< 数 式 >) 章 
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3. 例句 


1 P1 =P_Curr' 一 一 设置 Pl 为 "当前 值 " 。 

2 If Deg(P1.C)<170 Or Deg(P1.C)>- 150 Then * NOErrl' 
于 - 150, 则 跳 转 到 * NOErrl 。 

3 ”Error 9100' 一 一 报警 。 

4 =*NOErrl ' 一 一 程序 分 支 标志 。 


如 果 P1.C 的 度数 (deg) 小 于 170 "或 大 


20.8 Dist 一 一 求 两 点 之 间 的 距离 
1. 功能 
求 两 点 之 间 的 距离 (mm)。 
2. 格式 
< 数值 变量 > = Dist(< 位 置 1 >,< 位 置 2>) 
3. 例句 
1 M1 = Dist(P1,P2) ' 一 一 Ml 为 Pl 与 P2 点 之 间 的 距离 。 
4. 说 明 


J 关节 点 无 法 使 用 本 功能 。 


20.9 Exp 计算 以 e 为 底 的 指数 函数 


1. 功能 

计算 以 e 为 底 的 指数 函数 。 
2. 格式 

< 数值 变量 > = Exp(< 数 式 >) 

3. 例句 


1 ML = Exp(2)' 一 一 ML =e。 


20. 10 Fix 计算 数据 的 整数 部 分 


1. 功能 
计算 数据 的 整数 部 分 。 
2. 格式 


< 数值 变量 > = Fix(< 数 式 >) 
3. 例句 


1 ML = 了 ix(5.5)' 一 一 ML =5。 


20. 11 Fram 建立 坐标 系 

1. 功能 

由 给 定 的 三 个 点 构建 一 个 坐标 系 标 准点 。 常 用 于 建立 新 的 工件 坐标 系 。 
2. 格式 


< 位 置 变量 4>= Fram(< 位 置 变量 1 >,< 位 置 变量 2 >,< 位 置 变量 3>) 


3. 术语 解释 

< 位 置 变量 1 >: 新 平面 上 的 原点 。 

< 位 置 变量 2 >: 新 平面 上 的 X 轴 上 的 一 点 。 
< 位 置 变量 3 >: 新 平面 上 的 Y 轴 上 的 一 点 。 
< 位 置 变量 4 >: 新 坐标 系 基 准点 。 

4. 例句 


1 Base P_NBase' 一 一 初始 坐标 系 

2 P10 = Fram(P1,P2,P3) ' 一 一 求 新 建 坐 标 系 (P1,P2,P3) 原 点 P10 在 世界 坐标 系 中 的 位 置 。 
3 ”P10= Inv(P10) ' 一 一 转换 。 
4 


Base P10' 一 一 Base P10 为 新 建 世界 坐标 系 。 


20. 12 Int 一 一 计算 数据 最 大 值 的 整数 


1. 功能 
Int 用 于 计算 数据 最 大 值 的 整数 。 
2. 格式 
< 数值 变量 > = Int(< 数 式 >) 
3. 例句 
1 Ml=Int(3.3)—— Ml= 3。 
20.13 Inv 对 位 置 数据 进行 “ 反 向 变换 ” 
1. 功能 


Inv 用 于 对 位 置 数据 进行 “ 反 向 变换 ”。 
Inv 指令 可 用 于 根据 当前 点 建立 新 的 “工件 坐标 系 ”, 如 图 20-1 所 示 。 在 视觉 功能 中 ,也 
可 以 用 于 计算 偏差 量 。 
2. 格式 
20 
< 位 置 变量 > = Inv< 位 置 变量 > 章 
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3. 例句 
1 Pl1= Inv(P1) ' 一 一 对 位 置 数据 P1 进行 " 反 向 变换 "。 


| 


基本 变换 数据 
Pl 二 一 一 一 一 新 世界 坐标 系 
E iNV(P1) 


基本 坐标 系 
Xb 


图 20-1 INV 转换 的 意义 


4. 说 明 

(1) 在 原 坐标 系 中 确定 一 点 P1; 

(2) 如 果 希 望 以 Pl 点 作为 新 坐标 系 的 原点 , 则 使 用 指令 INV 进行 变换 , 即 Pl=INV(P1)， 
则 以 P1 为 原点 建立 了 新 的 坐标 系 。 注 意图 中 INV(P1) 的 效果 。 


20.14 JtoP 一 一 将 关节 位 置 数据 转 成 “直角 


1. 功能 
JtoP 用 于 将 关节 位 置 数据 转 成 “直角 坐标 系数 据 ”。 
2. 格式 
< 位 置 变量 > = JtoP < 关节 变量 > 
3. 例句 
1 Pl=JtoP(J1) 一 一 将 关节 数据 J1 转 成 直角 坐标 系数 据 P1。 
4. 说 明 
注意 : 用 为 关节 变量 ; P1 为 位 置 型 变量 。 
20.15 Log 一 一 计算 常用 对 数 
1. 功能 
Log 用 于 计算 常用 对 数 ( 以 10 为 底 的 对 数 ) 。 
2. 格式 


< 数值 变量 > = Log < 数 式 > 


3. 例句 


1 Ml= Log (2) 一 ML= 0.301030。 
20. 16 Max 计算 最 大 值 
1. 功能 
Max 用 于 求 出 一 组 数据 中 的 最 大 值 。 
2. 格式 
< 数值 变量 > = Max(< 数 式 1 >,< 数 式 2>,< 数 式 3>) 
3. 例句 
1 MI1 = Max(2,1,3,4,10,100) 一 一 ML=100。 


这 一 组 数据 中 最 大 的 数 是 100。 
20. 17 “Min 一 一 求 最 小 值 


1. 功能 
Min 用 于 求 出 一 组 数据 中 的 最 小 值 。 
2. 格式 


< 数值 变量 > = Min(< 数 式 1 >,< 数 式 2 >,< 数 式 3>) 
3. 例句 
1 Ml=Min (2,1,3,4,10,100) ' 一 一 ML =1。 


这 一 组 数据 中 最 小 的 数 是 1 。 
20. 18 ”PosCq 一 一 检查 给 出 的 位 置 点 是 否 


在 允许 动作 区 域内 
1. 功能 
PosCq 用 于 检查 给 出 的 位 置 点 是 否 在 允许 动作 范围 区 域内 。 
2. 格式 


< 数值 变量 > = PosCq< 位 置 变量 > 
< 位 置 变量 >: 可 以 是 直 交 型 也 可 以 是 关节 型 位 置 变 量 。 


3. 例句 

1 Ml = PosCq(P1) ' 一 一 检查 Pl 点 是 否 在 允许 动作 范围 区 域内 。 

4. 说 明 20 
如 果 Pl 点 在 动作 范围 以 内 ,M1 二 1。 章 
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如 果 P1 点 在 动作 范围 以 外 ,M1 二 0。 


20.19 PosMid 求 出 两 点 之 间 做 直线 插 补 


的 中 间 位 置 点 
1. 功能 
PosMid 用 于 求 出 两 点 之 间 做 直线 插 补 的 中 间 位 置 点 。 
2. 格式 
< 位 置 变量 > = PosCq< 位 置 变量 1 >,< 位 置 变量 2 >,< 数 式 1 >,< 数 式 2> 
< 位 置 变量 1 >: 直线 插 补 起 点 。 
< 位 置 变量 2 >: 直线 插 补 终点 。 
3. 例句 


1 Pl=PosMid(P2,P3,0,0) ' 一 一 Pl 点 为 P2、P3 点 的 中 间 位 置 点 。 


20. 20 “PtoJ 一 一 将 直 交 型 位 置 数据 转换 为 


关节 型 数据 
1. 功能 
PtoJ 用 于 将 直 交 型 位 置 数据 转换 为 关节 型 数据 。 
2. 格式 
< 关节 位 置 变 量 > = PtoJ < 直 交 位 置 变量 > 
3. 例句 
1 J1=PtoJ(P1) ' 一 一 将 直 交 型 位 置 数 据 Pl 转换 为 关节 型 数据 J1。 
4. 说 明 


J 为 关节 型 位 置 变量 。P1 为 直 交 型 位 置 变量 。 


20.21 Rad 将 角度 单位 转换 为 弧度 单位 
1. 功能 
Rad 用 于 将 角度 (deg) 单 位 转换 为 弧度 单位 (rad) 。 
2. 格式 
< 数值 变量 > = Ptod < 数 式 > 
3. 例句 


1 Pl1=P_Curr' 一 一 设置 Pl 为 当前 位 置 。 
2 P1.C= Rad(90) 一 一 将 Bl 的 C 轴 数值 转换 为 弧度 。 
3 ”Mov P1 ' 一 一 前 进 到 P1 点 。 


4. 说 明 
常常 用 于 对 位 置 变量 中 形 位 CA/B/C) 的 计算 和 三 角 函 数 的 计算 。 


20.22 Rdfl2 求 指定 关节 轴 的 “旋转 圈 数 ” 


1. 功能 
Rdfl2 用 于 求 指定 关节 轴 的 “旋转 圈 数 ”, 即 求 结构 标志 FL2 的 数据 。 
2. 格式 


< 设置 变量 > = Rdf12(< 位 置 变量 >,< 数 式 >) 
< 数 式 >: 指定 关节 轴 。 
3. 例句 


1 Bl1 = (100,0,100,180,0,180)(7,&H00100000)' 一 一 设置 Pl 点。 
2 ML = Rdf12(P1,6) 一 一 将 P1 点 C 轴 "旋转 圈 数 "赋值 到 M1。 


4. 说 明 

(1) 取得 的 数据 范围 : 一 8 一 7。 

(2) 结构 标志 FL2 由 32b 构成 。 旋 转圈 数 为 一 1 一 一 8 时 ,显示 形式 为 一 8。 

在 FL2 标志 中 ,FL2 王 00000000,bit0 一 7 对 应 轴 号 87654321。 每 1 位 的 数值 代表 旋转 
的 圈 数 。 正 数 表示 正 向 旋转 的 圈 数 。 

例如 : 

J6 轴 旋 转圈 数 = 十 1 圈 , 则 FL2 二 00100000。 

J6 轴 旋 转圈 数 = 一 1 圈 , 则 FL2 王 00F00000。 


20. 23 ”Rnd 一 一 产生 一 个 随机 数 


1. 功能 
Rnd 用 于 产生 一 个 随机 数 。 
2. 格式 


< 数值 变量 > = Rnd(< 数 式 >) 


< 数 式 >: 指定 随机 数 的 初始 值 。 
< 数值 变量 >: 数据 范围 0.0 一 1.0。 
3. 例句 


Dim MRND(10) ' 一 一 定义 数组 。 

Cl = Right $ (C_Time, 2) 一 一 (截取 字符 串 )Cl = "me" 。 

MRNDBS = Cvi(C1) 一 一 将 字符 串 "me" 转 换 为 数值 。 

MRND(1) = Rnd(MRNDBS) ' 一 一 以 MRNDBS 为 初始 值 产生 一 个 随机 数 。 

For M1 = 2 To 10 一 一 做 循环 指令 及 条 件 。 

MRND(M1) = Rnd(0) 一 一 以 0 为 初始 值 产生 一 个 随机 数 赋值 到 MRND(2) 一 MRND(10) 
Next M1 ' 一 一 进入 下 一 循环 。 


ou wb 


才 马 
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20. 24 ”SetJnt 一 一 设置 各 关节 变量 的 值 


1. 功能 
SetJnt 用 于 设置 “关节 型 位 置 变量 ”。 
2. 格式 


< 关节 型 位 置 变量 > = SetJnt <J1 轴 >,<J2 轴 >,<J3 轴 >,<J4 轴 >,<J5 轴 >,<J6 轴 >,<J7 轴 >,<J8 轴 > 
<J]l 轴 >\<J2 轴 >: 单位 为 弧度 (rad) 。 


3. 例句 

1 J1=J_Curr' 一 一 设置 J1 为 当前 值 。 

2 For M1 = 0 To 60 Step 10' 一 一 设置 循环 指令 及 循环 条 件 。 

3 M2=J1.J3+Rad(M1) ' 一 一 将 J1 点 J3 轴 数 据 加 ML( 弧 度 值 ) 后 赋值 到 M2 。 

4 J2= SetJnt(J1.J1, J1.J2, M2) ' 一 一 设置 使 J2 点 数据 (其 中 J3 轴 每 次 增加 10",J4 轴 以 后 为 相同 
的 值 ) 。 

5 Mov J2 ' 一 一 前 进 到 JI2 点 。 


6 
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8 
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Next M1 ' 一 一 下 一 循环 。 

M0 = Rad(0) ' 一 一 取 弧 度 值 。 

M90 = Rad(90) ' 一 一 取 弧 度 值 。 

J3 = SetJnt(M0, M0, M90, MO, M90, M0) 一 一 设置 J3 点 。 


10 Mov J3' 一 一 前 进 到 J3 点 。 


1 


20. 25 ”SetPos 一 一 设置 直 交 型 位 置 变 量 数值 


功能 


设置 直 交 型 位 置 变 量 数值 。 


2. 


格式 


< 位 置 变量 > = SetPos<X 轴 >,<Y 轴 >,<Z 轴 >,<R 轴 >,<B 轴 >,<C 轴 >,<L1 轴 >,<L2 轴 > 


3。 


术语 解释 


<X 轴 > 一 <Z 轴 >: 单位 为 mm。 
< A 轴 > 一 <C 轴 >: 单位 为 弧度 (rad)。 


4. 


ou Nb 


例句 

P1 =P_Curr' 一 一 设置 Pl 为 当前 值 。 

For M1 = 0 To 100 Step 10' 一 一 设置 循环 指令 及 循环 条 件 。 

M2=P1.Z+ M1 ' 一 一 将 "P1.2+ M1" 赋 值 到 "M2" 。 

P2 = SetPos(P1.X，P1.Y，M2) 一 一 设置 P2 点 (Z 轴 数 值 每 次 增加 10mm。A 轴 以 后 各 轴 数 值 不 变 ) 。 
Mov P2' 一 一 前 进 到 P2 点 。 

Next M1 ' 一 一 下 一 循环 。 


20.26 ”Sgn 一 一 求 数据 的 符号 
1. 功能 
求 数 据 的 符号 。 
2. 格式 
< 数值 变量 > = Sgn < 数 式 > 
3. 例句 


1 ML =- 12' 一 一 赋值 。 
2 M2= Sgn(M1) 一 一 求 Ml 的 符号 (M2 =-1)。 


4. 说 明 

< 数 式 > 一 正 数 ,< 数值 变量 > 一 1。 
< 数 式 > 二 0 ,< 数值 变量 > 二 0。 

< 数 式 > 一 负数 ,< 数值 变量 > 一 一 1。 


20.27 Sin 求 正 弦 值 


1. 功能 

求 正 弦 值 。 

2. 格式 

< 数值 变量 > = Sin < 数 式 > 
3. 例句 


1 M1=Sin(rad(60)) ' 一 一 ML =0.86603 


4. 说 明 
< 数 式 > 的 单位 为 弧度 。 


20.28 Sqr 求 平方 根 


1. 功能 

求 平方 根 。 

2. 格式 

< 数值 变量 > = Sqr < 数 式 > 

3. 例句 

1 ML = Sqr(2) 一 一 求 2 的 平方 根 (M1 = 1.41421) 
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20.29 Tan 求 正 切 
1. 功能 
求 正 切 。 
2. 格式 
< 数值 变量 > = Tan < 数 式 > 
3. 例句 
1 Ml= Tan (rad(60) ) ' 一 一 ML= 1.73205 
4. 说 明 
< 数 式 > 的 单位 为 弧度 。 
20. 30 “Zone 一 一 检查 指定 的 位 置 点 
是 否 进入 指定 的 区 域 

1. 功能 
Zone 用 于 检查 指定 的 位 置 点 是 否 进入 指定 的 区 域 ,如 图 20-2 所 示 。 

2 

图 20-2 指定 的 位 置 点 是 否 进入 指定 的 位 置 区 域 

2. 格式 


< 数值 变量 > = Zone < 位 置 1>,< 位 置 2>,< 位 置 3> 


< 位 置 1 >: 检测 点 。 

< 位 置 2 >,< 位 置 3>: 构成 指定 区 域 的 空间 对 角 点 。 
< 位 置 1 >,< 位 置 2 >,< 位 置 3 > 为 直 交 型 位 置 点 P。 
< 数值 变量 > 一 1: < 位 置 1 > 点 进入 指定 的 区 域 。 

< 数值 变量 > 二 0: < 位 置 1 > 点 没有 进入 指定 的 区 域 。 
3. 例句 


1 M1 = Zone(P1,P2,P3) 一 一 检测 Pl 点 是 否 进入 指定 的 空间 。 
2 If ML =1 Then Mov P_Safe Else End' 一 一 判断 - 执行 语句 。 


20.31 Zone2 检查 指定 的 位 置 点 是 否 
进入 指定 的 区 域 ( 圆 简 型 ) 


1. 功能 
Zone2 用 于 检查 指定 的 位 置 点 是 否 进入 指定 的 ( 圆 简 型 ) 区 域 ,如 图 20-3 所 示 。 
2. 格式 


< 数值 变量 > = Zone2 < 位 置 1 >, < 位置 2>,< 位 置 3>,< 数 式 > 


< 位 置 1 >: 被 检测 点 。 

< 位 置 2 >,< 位 置 3 >: 构成 指定 圆 简 区 域 的 空间 点 。 

< 数 式 >: 两 端 半球 的 半径 。 

< 位 置 1 >,< 位 置 2 >,< 位 置 3 >: 直 交 型 位 置 点 P。 

< 数值 变量 > 一 1: < 位 置 1 > 点 进入 指定 的 区 域 。 

< 数值 变量 > 一 0: < 位 置 1 > 点 没有 进入 指定 的 区 域 。 

Zone2 只 用 于 检查 指定 的 位 置 点 是 否 进入 指定 的 ( 圆 简 型 ) 区 域 , 不 考虑 形 位 。 
3. 例句 


1 M1 = Zone2(P1,P2,P3, 50) ' 一 一 检测 P1 点 是 否 进入 指定 的 空间 。 
2 If M1 = 1 Then Mov P_Safe Else End' 一 一 判断 - 执行 语句 。 


图 20-3 指定 的 位 置 点 是 否 进入 指定 的 位 置 区 域 


20. 32 Zone3 一 一 检查 指定 的 位 置 点 是 否 


进入 指定 的 区 域 ( 长 方 体 ) 
1. 功能 
检查 指定 的 位 置 点 是 否 进入 指定 的 区 域 ( 长 方 体 )。 
2. 格式 


< 数值 变量 > = Zone < 位 置 1 >,< 位 置 2 >,< 位 置 3>,< 位 置 4>,< 数 式 W>,< 数 式 H>,< 数 式 L> 


< 位 置 1 >: 检测 点 。 

< 位 置 2 >,< 位 置 3 >: 构成 指定 区 域 的 空间 点 。 

< 位 置 4>: 与 < 位 置 2>、< 位 置 3 > 共同 构成 指定 平面 的 点 。 
< 位 置 1 >,< 位 置 2 >,< 位 置 3 > 为 直 交 型 位 置 点 P。 

< 数 式 W >: 指定 区 域 宽 。 

< 数 式 H >: 指定 区 域 高 。 

< 数 式 L >: (以 < 位 置 2 >,< 位 置 3 > 为 基准 ) 指 定 区 域 长 。 
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< 数值 变量 > 二 1: < 位 置 1 > 点 进入 指定 的 区 域 。 
< 数值 变量 > 王 0: < 位 置 1 > 点 没有 进入 指定 的 区 域 。 
3. 例句 (如 图 20-4) 


1 ML = Zone3(P1,P2,P3,P4,100,100, 50) 一 一 检测 Pl 点 是 否 进入 指定 的 空间 。 
2 If M1 =1 Then Mov P_Safe Else End' 一 一 判断 -执行 语句 。 


20-4 ”指定 的 位 置 点 是 否 进入 指定 的 位 置 区 域 


20.33 ”需要 思考 的 问题 


(1) 如 何 计算 两 点 之 间 的 距离 ? 

(2) 如 何 对 位 置 数据 进行 反 向 变换 ? 

(3) 如 何 将 关节 位 置 数 据 转 成 直角 坐标 系数 据 ? 
(4) 如 何 将 直角 坐标 系数 据 转 成 关节 位 置 数据 ? 
(5) 如 何 使 用 Fram 函数 构建 一 个 新 的 坐标 系 ? 


| ”第 31 日 一 机 器 人 在 码 声 
第 21 章 项 目 中 的 应 用 


【学 习 目 的 】 
本 章 通 过 一 个 实际 案例 ,学习 机 器 人 在 码 埃 项 目 中 的 应 用 。 在 学 习 本 章 的 内 容 前 ,应 该 
先 复习 第 10 章 的 内 容 。 


21.1 项 目 综 述 


某 项 目 需要 使 用 机 器 人 对 包装 箱 进行 码 操 处 理 。 如 图 21-1 所 示 , 由 传送 线 将 包装 箱 传 
送 到 固定 位 置 , 再 由 机 器 人 抓 取 并 码 抬 。 码 夫 规格 要 求 为 6X8, 错 层 布 置 , 层 数 王 10, 左 右 
各 一 吉 。 


图 21-1 机 器 人 码 夫 流 水 线 工 作 示意 图 


21.2 解决 方案 


(1) 配置 机 器 人 一 台 作 为 工作 中 心 ,负责 工件 抓 取 搬运 码 埃 。 机 器 人 配置 32 点 输入 32 
点 输出 的 MO 卡 。 选 取 三 菱 RV-7FLL 机 器 人 ,该 机 器 人 搬运 重量 为 7kg, 最 大 动作 半径 为 
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1503mm。 由 于 是 码 埃 作 业 , 所 以 选取 机 器 人 的 动作 半径 要 求 尽 可 能 大 一 些 。 三 菱 RV- 
7FLL 臂 长 加 长 型 的 机 器 人 ,可 以 满足 工作 要 求 。 

(2) 示 教 单元 : R33TB( 必 须 选 配 ,用 于 示 教 位 置 点 ) 。 

(3) 机 器 人 选 件 : 输入 输出 信号 卡 2D-TZ368( 用 于 接收 外 部 操作 屏 信号 和 控制 外 围 设 
备 动作 )。 

(4) 选用 三 菱 PLC FX3U-48MR 作 主 控 系 统 , 用 于 控制 机 器 人 的 动作 并 处 理 外 部 检测 


(5) 触摸 屏 选用 GS2110。 触 摸 屏 可 以 直接 与 机 器 人 相连 接 , 直 接 设置 和 修改 各 工艺 参 
数 , 发 出 操作 信号 。 
21.2.1 硬件 配置 


根据 技术 经 济 性 分 析 , 选 定 硬件 配置 如 表 21-1 所 示 。 
表 21-1 硬件 配置 一 览 表 


序 号 名 称 型 号 数 量 备 ” 注 
1 机 器 人 RV-7FLL 1 萎 
这 简易 示 教 单元 R33TB 1 三 萎 
3 输入 输出 卡 2D-TZ368 1 三 萎 
4 PLC FX3U-48MR 1 三 萎 
5 GOT GS2110-WTBD 1 三 菱 


21.2.2 输入 输出 点 分 配 


根据 现场 控制 和 操作 的 需要 ,设计 输入 输出 点 ,输入 输出 点 通过 机 器 人 1/O 卡 TZ-368 
接 入 ,TZ-368 的 地 址 编号 是 机 器 人 识别 的 I/O 地址。 为 识别 方便 ,分 列 输入 输出 信号 。 输 
入 信号 一 览 表 如 表 21-2 所 示 , 输 出 信号 一 览 表 如 表 21-3 所 示 。 

表 21-2 输入 信和 号 一 览 表 
序 号 输入 信号 名 称 输入 地 址 (TZ-368) 

1 自动 启动 
2 自动 暂停 
3 复位 
4 伺服 ON 
5 伺服 OFF 
6 
休 
8 
9 


w 


报警 复位 

操作 权 

回 退 避 点 

机 械 锁定 

10 气压 检测 

11 输送 带 正常 运行 检测 

12 输送 带 进 料 端 有 料 无 料 检测 


四 |o|m |o|m|m| le 


~ 
o 


~ 
已 


~ 
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续 表 


序 号 输入 信号 名 称 输入 地 址 (TZ-368) 
13 输送 带 无 料 时 间 超 长 检测 13 
14 1 才 位 有 料 无 料 检测 14 
15 2 夫 位 有 料 无 料 检测 15 
16 吸盘 夹 紧 到 位 检测 29 
到 吸盘 松 开 到 位 检测 30 


表 21-3 输出 信号 一 览 表 


序 号 输出 信号 名 称 输出 信号 地 址 (TZ-368) 
1 机 器 人 自动 运行 中 0 
2 机 器 人 自动 暂停 中 4 
3 急 停 中 5 
4 报警 复位 2 
5 吸盘 ON 11 
6 吸盘 OFF 12 
加 输送 带 无 料 时 间 超 长 报警 18 


21.3 编 程 


21.3.1 总 工作 流程 


总 工作 流程 如 图 21-2 所 示 。 

(1) 初始 化 程序 。 

(2) 输送 带 有 料 无 料 判断 。 

@ 如 果 无 料 ,继续 判断 是 否 超 过 无 料 等 待 时 间 ,如 果 超 过 , 则 进入 报警 程序 ; 再 跳 到 程 
序 END 处 。 

@ 如 果 未 超过 “无 料 等 待 时 间 ”, 则 继续 进行 有 料 无 料 判 断 。 

@ 输送 带 有 料 无 料 判断 : 如 果 有 料 , 则 进行 1 井 夫 可 和 否 执行 码 埃 作 业 判 断 , 如 果 Yes， 
则 执行 1# 码 翅 人 作业。 如果 No, 则 执行 2 井 码 翅 作 业 。 

@ 进行 2# 埃 可 和 否 执行 码 埃 作 业 判 断 , 如 果 Yes, 则 执行 2 井 码 埃 作 业 , 如 果 No, 则 跳 到 
报警 提示 程序 ,再 执行 结束 END。 
21.3.2 编程 计划 

1. 程序 结构 分 析 

必须 从 宏观 着 手 编制 主 程序 ,只 有 在 编制 主 程序 时 考虑 周详 ,无 所 遗漏 ,安全 可 靠 ,保护 


严密 ,才能 达到 事半功倍 的 效果 。 
在 总 流程 图 上 主 程序 可 以 分 为 4 个 二 级 程序 ,如 表 21-4 所 示 。 
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初始 化 程序 


无 料 时 间 


1# 码 吉 程 序 


输送 带 有 料 无 料 判断 


2# 抬 位 可 和 否 装 料 


判断 


党 


1 


2# 码 才 程 序 


报警 程序 


上 一 


表 21-4 二 级 程序 汇总 表 


21-2 ” 码 才 操 作 总 流程 图 


序号 程序 名 称 程序 号 功能 上 级 程序 
1 初始 化 程序 CHUSH MAIN 
1# 码 夫 程 序 PLT199 MAIN 
3 2# 码 才 程 序 PLT299 MAIN 
4 报警 程序 BJ100 MAIN 


其 中 ,1# 码 埃 程 序 与 2# 码 才 程 序 内 又 各 自 可 按 层 数 分 为 10 个 子 程序 。 


如 表 21-5 所 示 。 


部 分 子 程序 


表 21-5 三 级 程序 汇总 表 
序号 程序 名 称 程序 号 功能 上 级 程序 
16 2#1 层 码 才 PLT21 PLT299 
17 2 并 2 层 码 才 PLT22 PLT299 
18 2#3 层 码 才 PLT23 PLT299 
19 2#4 层 码 才 PLT24 PLT299 
20 2#5 层 码 埃 PLT25 PLT299 
21 2#6 层 码 才 PLT26 PLT299 
22 2#7 层 码 才 PLT27 PLT299 


续 表 


序号 程序 名 称 程序 号 功能 上 级 程序 
23 2 并 8 层 码 才 PLT28 PLT299 
24 2 并 9 层 码 翅 PLT29 PLT299 
25 2#10 层 码 才 PLT210 PLT299 
2. 程序 汇总 表 


经 过 程序 结构 分 析 ,需要 编制 的 程序 如 表 21-6 所 示 。 
表 21-6 主 程序 子 程序 一 览 表 


序 号 程序 名 称 程 序 号 功 能 上 级 程序 

全 主 程序 MAIN 

2 初始 化 程序 CHUSH MAIN 
3 1# 码 才 程 序 PLT199 MAIN 
4 2 井 码 才 程 序 PLT299 MAIN 

5 报警 程序 BJ100 MAIN 
6 1#1 层 码 埃 PLT11 PLT199 
7 1#2 层 码 埃 PLT12 PLT199 
8 1 并 3 层 码 才 Ti PLT199 
9 1 间 4 层 码 才 PLT14 PLT199 
10 1#5 层 码 埃 PLT15 PLT199 
My 1 间 6 层 码 才 PLT16 PLT199 
12 1 间 7 层 码 才 PLT17 PLT199 
13 1#8 层 码 埃 PLT18 PLT199 
14 1#9 层 码 埃 PLT19 PLT199 
15 1#10 层 码 才 PLT110 PLT199 
16 2#1 层 码 堪 PLT21 PLT299 
到 2# 2 层 码 提 PLT22 PLT299 
18 2# 3 层 码 提 PLT23 PLT299 
19 2#4 层 码 才 PLT24 PLT299 
20 2#5 层 码 才 PLT25 PLT299 
21 2#6 层 码 井 PLT26 PLT299 
22 2#7 层 码 才 PLT27 PLT299 
5 2# 8 层 码 反 PLT28 PLT299 
24 2 提 9 层 码 才 PLT29 PLT299 
25 2 提 10 层 码 才 PLT210 PLT299 


经 过 实验 ,可 以 将 每 一 层 的 运动 程序 编制 为 一 个 子 程序 ,在 每 一 子 程序 中 都 重新 定义 
PLT( 和 矩阵 ?规格 ,而 且 每 一 层 的 矩阵 位 置 点 也 确实 与 上 下 一 层 各 不 相同 。 主 程序 就 是 顺序 
调用 子 程序 ,这 样 的 编程 简洁 明了 ,同时 也 不 受 PLT 指令 数量 的 限制 。 

3. 主 程序 MAIN 

根据 图 21-2 主 程序 流程 图 编制 的 主 程序 如 下 。 


1 CallP"CHUSH" ' 一 一 调用 初始 化 程序 。 
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2 *LRB1' 一 一 程序 分 支 标志 。 

3 Ifm IN(12) = 0 Then' 一 一 进行 输送 带 有 料 / 无 料 判断 。 
4 ”GOTO LAB2 一 一 如 果 输 送 带 无 料 则 跳 转 到 * LAB2。 

5 ”ELSE' 一 一 否则 往 下 执行 。 
6 
8 
9 


ENDIF 一 一 判断 语句 结束 。 
If m_IN(14) = 1 Then' 一 一 进行 1# 码 才 位 有 料 / 无 料 (是 否 码 才 完 成 ) 判 断 。 
GOTO LAB3 ' 一 一 如 果 1# 码 吉 位 有 料 ( 码 才 完 成 ) 则 跳 转 到 * LAB3。 
ELSE' 一 一 否则 往 下 执行 。 

10 ENDIF ' 一 一 判断 语句 结束 。 

11 CallP"PLT99"' 一 一 调用 1# 码 才 程 序 。 

12 * LRB4' 一 一 程序 结束 标志 。 

13 END' 一 一 程序 结束 。 

14 * LAB2 输送 带 无 料 程序 分 支 。 

15 If m_IN(13) = 1 Then' 一 一 进行 待 料 时 间 判 断 。 

16 m_0UT(13) = 1 ' 一 一 如 果 待 料 时 间 超 长 则 发 出 报警 。 

17 “GOTO * LAB4' 一 一 结束 程序 。 

18 ELSE' 一 一 否则 重新 检测 输送 带 有 料 /无 料 。 

19 GOTO * LAB1' 一 一 跳 转 到 * LAB1 行 。 

20 ENDIF' 一 一 判断 选择 语句 结束 。 

21 * LRB3' 一 一 1# 井 位 有 料 程序 分 支 , 转 人 对 2# 码 翅 位 的 处 理 。 

22 If m_IN(15) = 1 Then' 一 一 如 果 2# 井 位 有 料 , 则 报警 。 

23 nm_0UT(13) = 1 ' 一 一 指令 输出 信号 13 = ON。 

24 GOTO * LAB4' 一 一 结束 程序 。 

25 ELSE' 否则 

26 CallP"PLT199" ' 一 一 调用 2# 码 才 程 序 。 

27 ENDIF' 一 一 判断 选择 语句 结束 。 

28 END' 一 一 程序 结束 。 


4. 1# 夫 码 典 程 序 PLT99 


1 井 霹 码 霹 程 序 PLT99 又 分 为 10 个 子 程序 。 每 一 层 的 码 埃 分 为 一 个 子 程序 。 这 是 因 
为 其 一 包装 箱 需 要 错 层 布 置 ,防止 垮塌 ; 其 二 每 一 层 的 高 度 在 增加 ,需要 设置 Z 轴 坐 标 。 


CallP"PLT11" ' 一 一 调用 第 1 层 码 才 程 序 。 
Dly 1 一 一 暂停 1s。 

CallP"PLT12" ' 一 一 调用 第 2 层 码 志 程 序 。 
Dly 1° 暂停 1s。 

CallP"PLT13" ' 一 一 调用 第 3 层 码 才 程 序 。 
Dly 1 一 一 暂停 1s。 

CallP"PLT14" ' 一 一 调用 第 4 层 码 才 程 序 。 
Dly1°" 暂停 1s。 

9 ”CallP"PLT15"' 一 一 调用 第 5 层 码 夫 程 序 。 
10 Dly 1' 一 一 暂停 1s。 

11 CallP"PLT16"' 一 一 调用 第 6 层 码 才 程 序 。 
12 D1yY 1 暂停 1s。 

13 CallP"PLT17"' 一 一 调用 第 7 层 码 才 程 序 。 
14 D1Y 1 暂停 1s。 

15 CallP"PLT18"' 一 一 调用 第 8 层 码 才 程 序 。 
16 Dly 1 ' 一 一 暂停 1s。 

17 CallP"PLT19"' 一 一 调用 第 9 层 码 才 程 序 。 
18 Dly 1' 一 一 暂停 1s。 

19 CallP"PLT110" ' 一 一 调用 第 10 层 码 抬 程序 。 


oAUuAWDNDpr 


20 End' 一 一 程序 结束 。 
5. 码 埃 程 序 PLTI11(1# 志 第 1 层 ) 


码 抬 程序 PLT11 是 1 井 埃 第 1 层 的 码 志 程 序 ,在 这 个 程序 中 ,使 用 了 专用 的 码 夫 指 令 ， 


用 于 确定 每 一 格 的 定位 位 置 , 是 这 个 程序 的 关键 点 。 
图 21-3 是 1#1 层 码 夫 子 程序 的 流程 图 。 


(Hm ) AN 


抓 料 待 料 时 间 超 长 报警 


21-3 1#1 层 码 才 子 程序 的 流程 图 
在 码 吉 程 序 PLT11 中 ,其 运动 点 位 如 图 21-4 所 示 。 


4 | 
执 w 47 46 45 | 44 43 
| | 全 对 角 点 
37 | 38 39 40 141 秦 
| | | | | 
36 35 34 33 [32 al t 
25 36 37 38 125 
24 23 22 21 | 20 从 t 
13 14 15 16 i 18 
12 11 10 9 四 下 
一 一 一 
1 起 点 | 2 3 4 | 5 6 终点 A 
21-4 ”Plt 指令 定义 托盘 位 置 图 
1 Servo On' 伺服 ON。 


2 Ovrd 20' 一 一 设置 速度 倍率 。 
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3 ”一 一 以 下 对 托盘 1 各 位 置 点 进行 定义 

4 P10=P 01+(+0.00,+0.00, +0.00, +0.00, +0.00, + 0.00) 一 一 起 点 。 

5 P11=P10+(+0.00, +100.00, +0.00, + 0.00, + 0.00, + 0.00) 一 一 终点 aA。 

6 PB12=P10+ (+140.00, +0.00, +0.00, + 0.00, + 0.00, + 0.00) 一 一 终点 B。 

7 B13=P10+ (+140.00, +100.00, + 0.00, +0.00, + 0.00, + 0.00) ' 一 一 对 角 点 ,参见 图 21-4。 
8 DefPlt1, P10, P11,P12,P13,6,8,1' 一 一 定义 托盘 1。 

9 ml=1' 一 一 Ml 表示 各 位 置 点 。 


10 x* IOOP' 循 环 程序 起 点 标志 
11 If m_IN(11) = 0 Then * LAB1' 一 一 输送 带 有 料 /无 料 判断 。 如 果 无 料 , 则 跳 转 到 * LRB1 程序 分 支 


处 ,否则 往 下 执行 。 
12 Mov Pl1, - 50' 一 一 移动 到 输送 带 位 置 点 准备 抓 料 。 
13 Mvs P1' 一 一 前 进 到 Pl 点 。 


14 m_0UT(12) =1' 一 一 指令 吸盘 = ON。 

15 WAIT m_IN(12) = 1 ' 一 一 等 待 吸盘 = ON。 

16 Dly 0.5' 一 一 暂停 0.5s。 

17 Mvs, - 50' 一 一 退回 到 P1 点 的 " 近 点 "。 

18 P100= Pltl,ml' 一 一 以 变量 形式 表示 托盘 1 中 的 各 位 置 点 。 
19 Mvs P100, - 50 ' 一 一 运行 到 码 霖 位 置 点 准备 印 料 。 

20 Mvs P100' 一 一 前 进 到 P100 点 。 

21 m_0UT(12) = 0' 一 一 指令 吸盘 = 0FF, 印 料 。 

22 WAIT m_IN(12) = 0' 一 一 等 待 抒 料 完成 。 

23 Dly 0. 3' 一 一 暂停 0.3s。 

24 Mvs, - 50 ' 一 一 退回 到 P100 点 的 " 近 点 "。 

25 ml = ml + 1' 一 一 变量 加 1。 

26 If ml <= 48 Then * LOOP' 一 一 判断 : 如 果 变 量 小 于 等 于 48, 则 继续 循环 。 
一 一 否则 移动 到 输送 带 待 料 。 

28 Mov P1, - 50' 一 一 移动 到 输送 带 位 置 点 准备 抓 料 。 

29 End' 一 一 程序 结束 。 

30 * LAB1' 一 一 程序 分 支 标志 

If m_IN(12) = 1 Then m_0UT(10) =1' 一 一 如 果 待 料 时 间 超 长 , 则 报警 。 
32 一 一 否则 重新 进入 循环 * LOOP 

33 ”GOTO * LOOP' 一 一 跳 转 到 " * LOOP" 行 。 

34 End' 一 一 程序 结束 。 


6. 码 埃 程 序 PLT12(1# 埃 第 2 层 ) 


1 Servo 0n' 伺服 ON。 

2 ”Ovrd 20 ' 一 一 设置 速度 倍率 。 

rs 以 下 对 托盘 2 各 位 置 点 进行 定义 。 注 意 , 由 于 是 错 层 布置 ,各 起 点 、 终 点 、 对 角 点 位 置 要 重新 
计算 ,而 且 抓 手 要 旋转 一 个 角度 。 

4 P10=P 01+(+0.00,+0.00, +10x.00,+0.00,+0.00,+90) 一 一 起 点 

5 Bl11=P10+(+0.00,+10x.00,+0.00,+0.00, +0.00, +90) 一 一 终点 愉 

6  P12=P10+(+14#*.00, +0.00, +0.00, +0.00, +0.00, + 90) ' 一 一 终点 B 

7 P13=P10+(+14#x.00, +108.00, +0.00, +0.00, + 0.00, + 90) ' 一 一 对 角 点 

(省 略 ) 


码 抬 程序 PLT12(1 井 井 第 2 层 ) 与 码 抬 程序 PLT11(1# 井 第 1 层 ) 在 结构 形式 上 完 
相同 。 唯 一 区 别 是 托盘 2 的 起 点 坐标 在 Z 向 上 比 第 1 层 多 一 “ 层 高 数据。 注意 程序 中 序号 


SD 
=- 


w 
户 


第 4 行 , 其 中 ,Z 向 数值 比 码 埃 程 序 PLT11 多 一 “ 层 高 ”数值 。 由 于 是 错 层 布 置 ,各 起 点 、 终 
点 、 对 角 点 位 置 要 重新 计算 ,而 且 抓 手 要 旋转 一 个 角度 。 
其 余 各 层 程 序 PLT12 一 PLT110 均 做 如 此 处 理 。 


21.4 结 束 语 


机 器 人 在 码 埃 中 的 应 用 主要 使 用 PLT 指令 ,但 实质 上 PLT 指令 只 是 一 个 定义 矩阵 格 
中 心 位 置 的 指令 。 由 于 实际 码 志 一 般 需 要 错 层 布 置 ,所 以 不 能 一 个 PLT 指令 用 到 底 ,每 一 
层 的 位 置 都 需要 重新 定义 ,然后 使 用 循环 指令 反复 执行 抓 取 ,而 且 必须 作为 一 个 完整 的 系统 
工程 来 考虑 。 


21.5 需要 思考 的 问题 


(1) 如 何 根据 项 目 要 求 提出 控制 系统 的 配置 方案 ? 
(2) 如 何 分 析 主 程序 流程 图 构建 主 程序 结构 ? 

(3) 多 层 码 埃 每 层 工件 的 摆 放 位 置 是 否 相同 ? 

(4) 码 埃 指 令 的 实质 动作 是 什么 ? 

(5) 如 何 使 用 循环 指令 完成 码 埃 动 作 ? 
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第 22 章 第 22 日 一 机 器 人 在 手机 
检测 生产 线 上 的 应 用 


【学 习 目 的 】 

本 章 通 过 一 个 实际 案例 ,学 习 机 器 人 在 流水 线 检 测 项 目 中 的 应 用 。 学 习 案 例 重点 是 学 
习 如 何 规划 工艺 流程 ,编制 程序 流程 结构 ,如 何 调用 子 程序 ,如 何 使 用 判断 -执行 语句 进行 程 
序 跳 转 。 也 要 学 习 面 对 项 目 如 何 提出 解决 方案 和 构建 控制 系统 。 


22.1 项 目 综 述 


某 手 机 检测 生产 线 项 目 是 机 器 人 抓 取 手 机 (以 下 简称 工件 ) 进 行 检验 ,其 工作 过 程 如 下 : 
工件 在 流水 线 上 ,要 求 机 器 人 抓 取 工 件 置 于 检验 槽 中 ,检验 合格 再 抓 取 回流 水 线 进入 下 一 道 
工序 。 如 果 一 次 检验 不 合格 ,再 抓 取 工件 进入 另外 一 个 检验 槽 。 共 检验 三 次 ,如 果 全 不 合格 
则 放置 在 废品 槽 中 。 设 备 布置 如 图 22-1 所 示 。 


输送 带 出 料 端 输送 带 进 料 端 
输送 带 前 进 方向 


输送 带 | 


图 22-1 工程 项 目 设备 布置 图 


22.2 解决 方案 


经 过 技术 经 济 可 行 性 分 析 ,决定 采用 如 下 方案 。 

(1) 配置 机 器 人 一 台 作 为 工作 中 心 ,负责 工件 抓 取 搬运 。 机 器 人 配置 32 点 输入 32 点 
输出 的 1/O 卡 。 选 取 三 萎 RV-2F 机 器 人 ,该 机 器 人 搬运 重量 为 2kg, 最 大 动作 半径 504mm， 
可 以 满足 工作 要 求 。 

(2) 示 教 单元 : R33TB( 必 须 选 配 ,用 于 示 教 位 置 点 ) 。 

(3) 机 器 人 选 件 : 输入 输出 信号 卡 2D-TZ368( 用 于 接收 外 部 操作 屏 信号 和 控制 外 围 设 
备 动作 ) 。 

(4) 选用 三 菱 PLC FX3U-48MR 作 主 控 系统 ,用 于 控制 机 器 人 的 动作 并 处 理 外 部 检测 
信号 。 

(5) 配置 AD 模块 FX3U-4AD 用 于 接收 检测 信号 。 产 品 检测 仪 给 出 模拟 信号 ,由 AD 
模块 处 理 后 送 入 PLC 做 处 理 及 判断 。 

(6) 触摸 屏 选 用 GS2110。 触 摸 屏 可 以 直接 与 机 器 人 相连 接 , 直 接 设置 和 修改 各 工艺 参 
数 , 发 出 操作 信号 。 


22.2.1 硬件 配置 


硬件 配置 如 表 22-1 所 示 。 
表 22-1 硬件 配置 一 览 表 


序 号 名 称 型 号 数 量 备注 
和 机 器 人 RV-2F 1 三 
2 简易 示 教 单元 R33TB 1 = 
3 输入 输出 卡 2D-TZ368 1 a 
4 Fie FX3U-48MR 1 = 
5 AD 模块 FX3U-4AD 2 = 
6 GOT GS2110-WTBD 1 


22.2.2 输入 输出 点 分 配 


根据 项 目 要 求 ,需要 配置 的 输入 输出 信号 如 表 22-2 和 表 22-3 所 示 。 在 机 器 人 一 侧 需 
要 配置 I/O 卡 。1/O 卡 型 号 为 TZ-368。TZ-368 的 地 址 编号 是 机 器 人 识别 的 I/O 地 址 。 
1. 输入 信号 地 址 分 配 


表 22-2 输入 信号 地 址 一 览 表 


序 号 输入 信号 名 称 输入 地 址 (TZ-368) 
1 自动 启动 3 
2 自动 暂停 0 
3 复位 2 第 
4 伺服 ON 4 22 
草 
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续 表 
序 号 输入 信号 名 称 输入 地 址 (TZ-368) 
5 伺服 OFF 5 
6 报警 复位 6 
党 操作 权 7 
8 回 退 避 点 8 
9 机 械 锁定 9 
10 气压 检测 10 
11 输送 带 正常 运行 检测 11 
12 输送 带 进 料 端 有 料 无 料 检测 12 
13 输送 带 出 料 端 有 料 无 料 检测 13 
14 1 工 位 有 料 无 料 检测 14 
15 2 工 位 有 料 无 料 检测 15 
16 3 工 位 有 料 无 料 检测 16 
7 4 工 位 有 料 无 料 检测 17 
18 5 工 位 有 料 无 料 检 测 18 
19 6 工 位 有 料 无 料 检测 19 
20 1 工 位 检测 合格 信和 号 20 
21 2 工 位 检测 合格 信号 21 
22 3 工 位 检测 合格 信号 22 
23 4 工 位 检测 合格 信号 23 
24 5 工 位 检测 合格 信号 24 
25 6 工 位 检测 合格 信和 号 25 
26 1# 废 料 区 有 料 无 料 检测 26 
2 2# 废 料 区 有 料 无 料 检测 27 
28 3# 废 料 区 有 料 无 料 检测 28 
29 抓 手 夹 紧 到 位 29 
30 抓 手 松 开 到 位 30 
2. 输出 信号 地 址 分 配 
表 22-3 输出 信号 地 址 一 览 表 
序 号 输出 信号 名 称 输出 信号 地 址 (TZ-368) 
机 器 人 自动 运行 中 0 
2 机 器 人 自动 暂停 中 4 
3 急 停 中 5 
4 报警 复位 2 
5 抓 手 夹 紧 11 
6 抓 手 松 开 12 


3. 数值 型 变量 M 分 配 
由 于 本 项 目 中 机 器 人 程序 复杂 ,为 编写 程序 方便 ,预先 分 配 使 用 数值 型 变量 和 位 置 点 的 
范围 。 数 值 型 变量 分 配 如 表 22-4 所 示 。 


表 22-4 数值 型 变量 M 分 配 一 览 表 
一 -一 一 一 一 一 


序 号 数值 型 变量 名 称 应 用 范围 
1 M1~M99 主 程序 
2 M100~M199 上 料 程序 
M200~ M299 印 料 程序 
4 M300 一 M499 不 良品 检测 程序 
5 M201~ M206 1~6 工 位 有 料 无 料 检测 
6 M221~ M226 1~6 工 位 检测 次 数 

4. 位 置 变量 P 


位 置 变量 P 分 配 如 表 22-5 所 示 。 
表 22-5 位置 变量 P 分 配 一 览 表 


序 号 位 置 变 量 名 称 应 用 范 类 型 
P_30 机 器 人 工作 基准 点 全 局 
2 P_10 输送 带 进 料 端 位 置 全 局 
3 P_20 输送 带 出 料 端 位 置 全 局 
4 P_01 1# 工 位 位 置 点 全 局 
5 P_02 2# 工 位 位 置 点 全 局 
6 P_03 3# 工 位 位 置 点 全 局 
了 P_04 4# 工 位 位 置 点 全 局 
8 P_05 5# 工 位 位 置 点 全 局 
9 P_06 6# 工 位 位 置 点 全 局 
10 P_07 1# 不 良品 区 位 置 点 全 局 
11 P_08 2# 不 良品 区 位 置 点 全 局 
狐 P_09 3# 不 良品 区 位 置 点 全 局 


22.3 编 程 


22.3.1 总 流程 


1. 总 的 工作 流程 

由 于 机 器 人 程序 复杂 ,应 该 首先 编制 流程 图 ,根据 流程 图 编制 程序 流程 及 程序 框架 。 编 
制 流 程 图 时 ,需要 考虑 周全 ,确定 最 优 工 作 路 线 , 这 样 编程 才能 事半功倍。 

总 的 工作 流程 如 图 22-2 所 示 。 

(1) 系统 上 电 或 启动 后 ,首先 进入 “初始 化 ”程序 ,包括 检测 输送 带 是 否 启动 ,启动 气泵 
并 检测 气压 及 报警 程序 。 

(2) 进入 卸 料 工序 ,只 有 先 将 测试 区 的 工件 搬运 回 输送 线 上 ,才能 够 进行 下 一 工 步 。 

(3) 在 外 料 工 步 执行 完毕 后 ,进入 * 不 良品 处 理工 序 ”。 在 “不 良品 处 理工 序 ” 中 ,要 对 检 
测 不 合格 的 产品 执行 三 次 检测 ,三 次 不 合格 才 判 定 为 不 良品 。 从 机 器 人 动作 来 看 ,要 将 同一 
工件 置 于 不 同 的 三 个 测试 工 位 中 进行 测试 。 测 试 不 合格 才 将 工件 转 入 “不 良品 区 ”。 执 行 


第 
2 
章 
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“不 良品 处 理工 步 ? 也 是 要 空 出 “测试 区 ”。 

(4) 经 过 “外 料 工 步 ? 和 * 不 良品 处 理工 步 " 后 ,测试 区 各 工 位 已 经 最 大 限度 空 出 ,所 以 执 
行 “上 料 工 步 ”。 

(5) 如 果 工 作 过 程 中 发 生机 器 人 系统 的 报警 ,机 器 人 会 停止 工作 。 外 部 也 配置 有 * 急 停 
按钮 "。 按 下 “ 急 停 按钮 "后 ,系统 立即 停止 工作 。 

(6) 总 程序 可 以 设置 为 “反复 循环 类 型 ”", 即 启动 之 后 反复 循环 执行 ,直到 接收 到 停止 指 
令 。 图 22-2 是 总 工作 流程 图 。 


开始 
初始 化 程序 
于 a 
是 否 可 执行 卸 料 ? 
02 抒 料 程序 N 
fe 
本 03 不 良品 
处 置 程序 
01 上 料 程序 


22-2 总 工作 流程 图 


2. 主 程序 MAIN 
根据 总 流程 图 编制 的 主 程序 MAIN 如 下 。 


1 CALLP "CSH" ' 一 一 调用 初始 化 程序 。 

2 “一 一 进入 印 料 工 步 判 断 。 

3 IFM210=6 THEN x LAB2' 一 一 如 果 全 部 工 位 检测 不 合格 则 跳 * LAB2。 

4 IFM_IN(13) =1 THEN * LAB2' 一 一 如 果 输 送 带 出 口 段 有 料 则 跳 到 * LAB2。 
5 ”CALLP "XIEL" ,一 一 调用 外 料 程序 。 
6 

党 
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GOTO * LAB4' 一 一 跳 转 到 x LAB4 行 。 
' x* LAB2 "不 良品 工 步 " 标 记 。 
一 一 进入 "不 良品 工 步 " 工 步 判 断 。 
IE M310 = 0 THEN * LAB3' 一 一 如 果 全 部 工 位 检测 合格 则 跳 * LAB3。 
10 IF M310 = 6 THEN x LAB5' 一 一 如 果 全 部 工 位 检测 不 合格 则 跳 * LAB5 报警 程序 。 
11 CALLP "BULP"' 一 一 调用 不 良品 处 理 程序 。 
12 GOTO * LAB4' 一 一 跳 转 到 * LAB4 行 。 
13 *LAB3' 一 一 上 料 程序 标记 。 
14 IF M110=6 THEN xLAB4' 一 一 如 果 全 部 工 位 有 料 则 跳 到 * LAB4。 
15 IF M_IN(12) =1 THEN x LAB4' 一 一 如 果 输 送 带 进口 段 无 料 则 跳 到 * LAB4。 
16 CALLP "SL"' 一 一 调用 上 料 程序 。 
17 x LAB4' 一 一 主 程序 结束 标志 。 


18 END ' 一 一 程序 结束 。 

19 x LRB5 ' 一 一 报警 程序 。 

20 CALLP"BA0J" ' 一 一 调用 报警 程序 。 
21 END ' 一 一 程序 结束 。 


22.3.2 初始 化 程序 流程 


初始 化 包括 检测 输送 带 是 否 启动 ,启动 气泵 并 检测 气压 等 工作 。 初 始 化 的 工作 流程 如 
图 22-3 所 示 。 


启动 输送 带 


一 


ee 启动 气泵 


其 他 程序 


初始 化 程序 


22-3 初始 化 工作 流程 


22.3.3 上 料 流程 


1. 上 料 程序 流程 及 要 求 

(1) 上 料 程序 必须 首先 判断 : 

@ 输送 带 进口 段 上 是 否 有 料 ? 

@ 测试 区 是 否 有 空余 工 位 ? 

(2) 如 果 不 满 足 这 两 个 条 件 ,就 结束 上 料 程序 返回 主 程序 。 

(3) 如 果 满 足 这 两 个 条 件 , 则 逐一 判断 空余 工 位 ,然后 执行 相应 的 搬运 程序 。 

(4) 由 于 上 料 动作 必须 将 工件 压 入 测试 工 位 槽 中 ,所 以 采用 了 机 器 人 的 柔性 控制 功能 ， 
在 压 人 过 程 中 如 果 遇 到 过 大 阻力 , 则 机 器 人 会 自动 做 相应 调整 ,这 是 关键 技术 之 一 。 

(5) 每 一 次 搬运 动作 结束 后 ,不 是 回 到 程序 END 处 ,而 是 回 到 程序 起 始 处 重新 判断 , 直 全 
到 6 个 工件 全 部 装 满 。 22 
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2. 上 料 工 步 流程 图 
上 料 工 步 流程 图 如 图 22-4 所 示 。 


是 否 有 空余 工 位 判断 
入 


10T011 上 料 程序 


1 


10T012 上 料 程序 


GOTO*SL 


10T014 上 料 程 序 


10T016 上 料 程序 


10T015 上 料 程序 


1 


5 工 位 有 料 无 料 判断 


Y 
N 
6 工 位 有 料 无 料 判断 
区 


END 


图 22-4 上 料 工 步 流程 图 


3. 上 料 程序 SL 

1 x SL 程序 分 支 标签 

2 M101=M_In (14) 一 一 1 工 位 有 料 无 料 检 测 信号。 

3 M102=M_In (15)' 一 一 2 工 位 有 料 无 料 检测 信号 。 

4 M103 =M_In (16) 一 一 3 工 位 有 料 无 料 检测 信和 号 。 

5 M104=M In (17)' 一 一 4 工 位 有 料 无 料 检测 信和 号。 

6 M105=M In (18) 一 一 5 工 位 有 料 无 料 检测 信号 。 

7 M106 =M_In (19) 一 一 6 工 位 有 料 无 料 检测 信号 。 

8 M110=M101% +M102% +M103% +M104% +M105g% + M106g# ' 一 一 全 部 工 位 有 料 无 料 状态 。 
9 ”IF M110=6 THEN *LRB' 一 一 如 果 全 部 工 位 有 料 则 跳 到 程序 结束 。 

3 JIFM IN(12) =1 THEN *LAB' 一 一 如 果 输 送 带 无 料 则 跳 到 程序 结束 。 


MSN 
3 


w 
to 


4. 


一 一 如 果 1 工 位 无 料 就 执行 上 料 程序 "10T011", 否则 进行 2 工 位 判断 。 
IF M_In (14) = 0 THEN' 一 一 如 果 1 工 位 无 料 
CALLP"10TO11" ' 一 一 调用 上 料 程序 "10TO11" 
GOTO * SL' 一 一 跳 转 到 * SL 
ELSE' 一 一 否则 
ENDIF ' 一 一 结束 判断 执行 语句 。 
' 如 果 2 工 位 无 料 就 执行 上 料 程序 "10T012", 和 否则 进行 3 工 位 判断 。 
IFM_ In (15) =0 THEN 
CRLLP"10TO12" 
GOTO * SL 
ELSE'(2) 
ENDIF 
' 如 果 3 工 位 无 料 就 执行 上 料 程序 "10TO13", 否则 进行 4 工 位 判断 。 
IF M_In (16) =0 THEN 
CRLLP"10TO13" 
ELSE'(3) 19 GOTO * SL 
ENDIF 
' 如 果 4 工 位 无 料 就 执行 上 料 程序 "10T014", 和 否则 进行 5 工 位 判断 。 
IF M_In (17) =0 THEN 
CALLP"10TO14" 
GOTO * SL 
ELSE'(4) 
ENDIF 
' 如 果 5 工 位 无 料 就 执行 上 料 程序 "10T015", 和 否则 进行 6 工 位 判断 。 
IFM_ In (18) = 0 THEN 
CALLP"10TO15" 
GOTO * SL 
ELSE'(5) 
ENDIF 
' 如 果 6 工 位 无 料 就 执行 上 料 程序 "10T7016", 否则 结束 上 料 程序 。 
IFM_In (19) = 0 THEN 
CRLLP"10TO16" 
ELSE'(6) 
ENDIF'(6) 
x* LAB 
END 


程序 10TO11 


本 程序 用 于 从 输送 带 抓 料 到 1# 工 作 位 ,使 用 了 和 柔性 控制 功能 。 


ownaouwewmb pr 


SERVOON ' 伺服 ON。 

OVRD100 一 一 速度 倍率 100 % 。 

MOV P_10, 50' 一 一 快 进 到 输送 带 进 料 端 位 置 点 上 方 50mm。 
OVRD 20' 一 一 设置 速度 倍率 为 20 % 。 

MVS P_10 一 一 慢 速 移动 到 输送 带 进 料 端 位 置 点 。 
M_oUT(11) = 1 一 一 抓 手 ON。 

WAIT M_IN(29) = 1 ' 一 一 等 待 抓 手 夹 紧 完 成 。 

DLY 0.3' 一 一 暂停 0.3s。 

MOV P_10, 50。' 一 一 移动 到 输送 带 进 料 端 位 置 点 上 方 50mm。 
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10 OVRD 100 ' 一 一 设置 速度 倍率 为 100 % 。 

11 MOV P_01, 50' 一 一 快 进 到 1# 工 位 位 置 点 上 方 50mm。 
12 OVRD20' 一 一 设置 速度 倍率 为 20 % 。 

13 CmpG1, 1, 0.7, 1, 1, 1,， 一 一 设置 各 轴 和 柔性 控制 增益 值 。 
14 CnmpPos，&B000100 一 一 设置 Z 轴 为 柔性 控制 轴 。 

15 MVS P_01 一 一 到 1# 工 位 位 置 点 。 

16 M_0UT(11) = 0' 一 一 松 开 抓 手 。 

17 WAIT M_IN(30) = 1 一 一 等 待 抓 手 松 开 完 成 。 

18 DLY 0. 3 ' 一 一 暂停 0.3s。 

19 OVRD100 ' 一 一 设置 速度 倍率 为 100 % 。 

20 Cnpoff ' 一 一 关闭 柔性 控制 功能 。 

21 MOV P_01, 50' 一 一 移动 到 1# 工 位 位 置 点 上 方 50mm。 
22 MOV P_30 ' 一 一 移动 到 基准 点 。 

23 ”END' 一 一 主 程序 结束 。 


22.3.4 匈 料 工序 流程 


1. 秃 料 程序 的 流程 及 要 求 

(1) 务 料 程序 必须 首先 判断 : 

Q@ 输送 带 出 口 自 上 是 否 有 料 ? 

@ 测试 区 是 否 有 合格 工件 ? 

(2) 如 果 不 满足 这 两 个 条 件 ,就 结束 卸 料 程序 返回 主 程序 。 

(3) 如 果 满 足 这 两 个 条 件 , 则 逐一 判断 合格 工件 所 在 工 位 ,然后 执行 相应 的 搬运 程序 。 

(4) 每 一 次 搬运 动作 结束 后 ,不 是 回 到 程序 END 处 ,而 是 回 到 程序 起 始 处 重新 判断 , 直 
到 全 部 合格 工件 被 搬运 到 输送 带 上 。 

2. 和 伸 料 工 步 流 程 图 

印 料 工 步 流程 图 如 图 22-5 所 示 。 

3. 印 料 程序 XIEL 


* XIEL 程序 分 支 标签 

M201 = M_In (20) ' 一 一 1 工 位 检测 合格 信号 。 
M202 = M_In (21) ' 一 一 2 工 位 检测 合格 信号 。 
M203=M_In (22) ' 一 一 3 工 位 检测 合格 信号 。 
M204 = M_In (23) ' 一 一 4 工 位 检测 合格 信号 。 
M205 = M_In (24) ' 一 一 5 工 位 检测 合格 信号 。 
M206 =M_In (25) ' 一 一 6 工 位 检测 合格 信号 。 
一 一 检测 合格 信号 = 0 检测 不 合格 信号 = 1 

8 M210 = M201 + M202 + M203 + M204 + M205 + M206 
9 IF M210 =6 THEN * LRB20' 一 一 如 果 全 部 工 位 检测 不 合格 则 跳 到 程序 结束 。 
3 JIFM IN(13) =1 THEN * LRB20' 一 一 如 果 输 送 带 有 料 则 跳 到 程序 结束 。 

4 ”一 一 如 果 1 工 位 检测 合格 就 执行 卸 料 程序 "21T020", 否则 进行 2 工 位 判断 。 
5 IFMIn (20) =0 THEN 
6 
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CRLLP"21TO20" 
GOTO * XIEL 
ELSE'(1) 
ENDIF 


10 
11 
12 
13 
14 
15 
16 
17 
18 
19 
20 
21 


*XIEL 


1 
N 
是 否 有 合格 产品 判断 END 
1 时 


Y 
20T021 和 卸 料 程序 1 工 位 是 否 有 合格 品 


GOTO*XIEL 


20T023 印 料 程序 


GOTO*XIEL 


20T025 印 料 程序 


GOTO*XIEL 


20T022 抒 料 程序 


GOTO*XIEL 


20T024 缀 料 程序 


GOTO*XIEL 


3 工 位 是 否 有 合格 品 


5 工 位 是 否 有 合格 


6 工 位 是 否 有 合格 20T026 和 卸 料 程序 


22-5 务 料 工 步 流 程 图 


一 一 ' 如 果 2 工 位 检测 合格 就 执行 卸 料 程序 "22T020", 否 则 进行 3 工 位 判断 。 
IF M_In (21) = 0 THEN 
CALLP"22TO20" 

GOTO * XIEL 

ELSE'(2) 


ENDIF 


一 一 如 果 3 工 位 检测 合格 就 执行 印 料 程序 "23TO20", 否则 进行 4 工 位 判断 。 
IFEM In (22) = 0 THEN 
CRLLP"23TO20" 

GOTO x XIEL 

ELSE'(3) 


ENDIF 
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22 一 一 如 果 4 工 位 检测 合格 就 执行 印 料 程序 "24T020", 否则 进行 5 工 位 判断 。 
23 IF M_In (23) =0 THEN 

24 CRLLP"24TO20" 

25 GOTO x XIEL 

26 ELSE'(4) 

27 ENDIF 

28 ' 一 一 如 果 5 工 位 检测 合格 就 执行 印 料 程序 "25T020", 否则 进行 6 工 位 判断 。 
29 IFM In (24) =0 THEN 

30 CRLLP"25TO20" 

31 GOTO * XIEL 

32 ELSE'(5) 

33 ENDIF 

34 一 一 如 果 6 工 位 检测 合格 就 执行 抒 料 程序 "26TO020", 否则 GOTO END。 

35 IF M_In (25) =0 THEN 

36 CALLP"25TO20" 

37 ELSE'(6) 

38 ENDIF'(6) 

39 *LAB20 

40 END 


22.3.5 不 良品 处 理 程序 


1. 程序 的 要 求 及 流程 

(1) 在 "不 良品 处 理工 序 " 中 ,要 对 检测 不 合格 的 产品 执行 三 次 检测 ,三 次 不 合格 才 判 定 
为 不 良品 。 从 机 器 人 动作 来 看 ,要 将 同一 工件 置 于 不 同 的 三 个 测试 工 位 中 进行 测试 。 测 试 
不 合格 才 将 工件 转 入 “不 良品 区 ”。 因 此 在 “不 良品 处 理工 序 ” 中 : 

@ 首先 判断 有 无 不 良品 ?无 不 良品 则 结束 本 程序 返回 上 一 级 程序 。 

@ 是 否 全 部 为 不 良品 ? 如 果 全 部 为 不 良品 , 则 必须 报警 ,因为 可 能 是 出 现 了 重大 质量 
问题 ,需要 停机 检测 。 

(2) 如 果 不 满足 以 上 条 件 , 则 逐一 判断 不 良品 所 在 工 位 ,判断 完成 后 ,执行 相应 的 搬运 
程序 。 
(3) 在 下 一 级 子 程序 中 ,还 需要 判断 是 否 有 空余 工 位 ,并 且 标 定 检测 次 数 ,在 检测 次 数 
为 3 时 ,将 工件 搬运 到 “不 良品 区 ”。 

2. 不 良品 处 理 程 序 流程 图 

不 良品 处 理 程序 流程 图 如 图 22-6 所 示 。 

3. 不 良品 处 理 程序 BULP 

* BULP 程序 分 支 标签 
M301 = M_In (20) 一 一 1 工 位 检测 合格 信和 号。 
M302=M_In (21) 一 一 2 工 位 检测 合格 信号 。 
M303 =M_In (22) 一 一 3 工 位 检测 合格 信号 。 
M304 =M_In (23) 一 一 4 工 位 检测 合格 信和 号。 
M305 = M_In (24) 一 一 5 工 位 检测 合格 信号 。 
M306 =M_In (25) ' 一 一 6 工 位 检测 合格 信和 号。 
一 一 检测 合格 信号 = 0, 检 测 不 合格 信号 = 1。 
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N 
不 良品 有 无 判断 END 
Y 
这 
是 否 全 部 为 不 良品 ? 报警 程序 BAOJ 
END 


31TOX 装 料 程序 


工 位 有 无 不 良品 ; 32 TOX 装 料 程序 


家 | 


33 TOX 装 料 程序 3 工 位 有 无 不 良品 判 
4 工 位 有 无 不 良 


5 工 位 有 无 不 良 上 


34 TOX 装 料 程序 
GOTO*BULP 


36 TOX 装 料 程序 


图 22-6 不 良品 处 理 流程 图 


M310 = M301 + M302 + M303 + M304 + M305 + M306 
IF M310 = 0 THEN x* LAB2' 一 一 如 果 全 部 工 位 检测 合格 则 跳 到 * LAB2( 结 束 程序 )。 
IF M310 = 6 THEN x LAB3' 一 一 如 果 全 部 工 位 检测 不 合格 则 跳 到 报警 程序 。 
一 一 如 果 1 工 位 检测 不 合格 就 执行 转运 程序 "31TOX", 否则 进行 2 工 位 判断 。 

5 IFMIn (20) =1 THEN 

6 CALLP"31TOX" 

7 GOTOx BULP ------ ' 回 程序 起 始 行 。 

8 

9 


10 一 一 如 果 2 工 位 检测 不 合格 就 执行 转运 程序 "32TOX", 否则 进行 3 工 位 判断 。 
11 IF MIn (21) =1 THEN 
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12 CALLP"32TOX" 

13 GOTOx BULP 

14 ELSE'(2) 

15 ENDIF 

16 ' 一 一 如 果 3 工 位 检测 不 合格 就 执行 转运 程序 "33TOX", 否则 进行 4 工 位 判断 。 
17 IF M In (22) =1 THEN 

18 CALLP"33TOX" 

19 GOTO* BULP 

20 ELSE'(3) 

21 ENDIF 

22 一 一 如 果 4 工 位 检测 不 合格 就 执行 转运 程序 "34TOX", 否则 进行 5 工 位 判断 。 
23 IF M_In (23) =1 THEN 

24 CALLP"31TOX" 

25 GOTO* BULP 

26 ELSE'(4) 

27 ENDIF 

28 一 一 如 果 5 工 位 检测 不 合格 就 执行 转运 程序 "35TOX", 否则 进行 6 工 位 判断 。 
29 IFM In (24) =1 THEN 

30 CALLP"35TOX" 

31 GOTO* BULP 

32 ELSE'(5) 

33 ENDIF 

34 一 一 如 果 6 工 位 检测 不 合格 就 执行 转运 程序 "36TOx", 否则 结束 程序 。 
35 IF M_In (24) =1 THEN 

36 CALLP"36TOX" 

37 ELSE'(6) 

38 ENDIF'(6) 

x* LAB2 

END 

39 *LAB3 

40 END 
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22.3.6 不 良品 在 1 间 工 位 的 处 理 流程 


1. 不 良品 在 1# 工 位 的 处 理 程 序 (31TOX) 流 程 

不 良品 在 1# 工 位 的 处 理 程 序 (31TOX) 流 程 图 如 图 22-7 所 示 。 

(1) 当 1# 工 位 (包括 2~~5# 工 位 ) 有 不 良品 时 , 先 要 进行 检测 次 数 判 断 。 工 艺 规定 对 
每 一 工件 要 进行 三 次 检测 ,如果 三 次 检测 都 不 合格 , 才 可 以 判断 为 不 良品 。 

(2) 当 检 测 次 数 二 3 时 ,进入 “31TOFEIP” 程 序 ( 将 工件 放 入 “不 良品 区 ”)。 

(3) 当 检 测 次 数 =2 时 ,进入 “31TO2X” 子 程序 (将 工件 放 入 “其 他 工 位 ”进行 第 三 次 
检测 ) 。 

(4) 当 检 测 次 数 =0( 第 1 次 ) 时 ,进入 "31TOX”? 子 程序 (将 工件 放 入 “其 他 工 位 进行 第 
二 次 检测 ) 。 

如 果 检 测 次 数 =0( 初 始 值 ) , 则 顺序 判断 各 工 位 有 料 无 料 状态 ,执行 相应 的 搬运 程序 。 

为 此 必须 标定 检测 次 数 , 从 1# 工 位 将 工件 转运 到 N# 工 位 后 必须 对 各 工 位 的 检验 次 


*1GWBULP 


31 TOFEIP y 
装 料 程序 柏 测 次数 光电 
N 
和 
END 给 测 次 数 判断 31 TO2X 装 料 程序 
=2? 
END 
N 
N 
了 位 有 料 无 料 判 果 31TO2 装 料 程序 
区 
N END 


31TO3 装 料 程序 无 料 判 


4 工 位 有 料 无 料 判 31TO4 装 料 程序 


5 于 位 有 笠 Ee 


31 TO5 装 料 程序 


6 工 位 有 料 31 TO6 装 料 程序 


图 22-7 不 良品 在 1# 工 位 的 处 理 程序 (31TOX) 流 程 


数 进行 标定 ,同时 清 掉 1# 工 位 的 检测 次 数 。 
2. 不 良品 在 1# 工 位 的 处 理 程序 31TOX 


* 1GWEIBULP' 一 一 程序 分 支 标签 

一 一 如 果 检 测 次 数 = 3 就 执行 不 良品 转运 程序 "31TOFEIP", 否则 进行 下 一 判断 。 
IF M221 = 3 THEN CALLP "31TOFEIP" 

一 一 如 果 检 测 次 数 = 2 就 执行 转运 程序 "31TO2x", 否则 进行 下 一 判断 。 

IF M221 = 2 THEN CALLP "31TO2X" 

一 一 如 果 2 工 位 无 料 就 执行 转运 程序 "31T02", 否则 进行 3 工 位 判断 。 

IFM In (14) =0 THEN 

CALLP"31TO2" 

M222 = 2 一 一 标定 2 工 位 检测 次 数 = 2 


吕 omowaouewn 


10 M221 = 0' 一 一 标定 1 工 位 检测 次 数 =0 第 
11 GOTO x LAB2 22 
12 ELSE'(1) 章 
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13 ENDIF 

一 一 如 果 3 工 位 无 料 就 执行 转运 程序 "31T03", 否则 进行 4 工 位 判断 。 
14 IF MIn (15) =0 THEN 

15 CRLLP"31T03" 

16 M223=2' 一 一 标定 3 工 位 检测 次 数 = 2。 

17 M221 = 0 一 一 标定 1 工 位 检测 次 数 = 0。 

18 GOTO* LAB2 

19 ELSE'(2) 

20 ENDIF 

21 一 一 如 果 4 工 位 无 料 就 执行 转运 程序 "31T04", 否则 进行 5 工 位 判断 。 
22 IFM In (17) =0 THEN 

23 CRLLP"31TO4" 

24 M224 = 2 ,一 一 标定 4 工 位 检测 次 数 = 2。 

25 M221 = 0' 一 一 标定 1 工 位 检测 次 数 = 0。 

26 ”GOTO * LRB2 

27 ELSE'(3) 

28 ENDIF 

29 ' 一 一 如 果 5 工 位 无 料 就 执行 转运 程序 "31T05", 否 则 进行 6 工 位 判断 。 
30 IFM In (18) =0 THEN 

31 CALLP"31TO5" 

32 M225 = 2' 一 一 标定 5 工 位 检测 次 数 = 2。 

33 ”M221 = 0' 一 一 标定 1 工 位 检测 次 数 = 0。 

34 GOTO* LAB2 

35 ELSE'(4) 

36 ENDIF 

37 一 一 如 果 6 工 位 无 料 就 执行 转运 程序 "31T06", 否则 GOTO END。 
38 IFM In(1) =0 THEN 

39 CRLLP"31T06" 

40 M226 = 2 ' 一 一 标定 5 工 位 检测 次 数 = 2。 

41 M221 = 0' 一 一 标定 1 工 位 检测 次 数 = 0。 

42 GOTO * LRB2 

43 ELSE'(5) 

44 ENDIF 

45 “一 一 如 果 6 工 位 检测 不 合格 就 执行 转运 程序 "36TOX", 否则 结束 程序 。 
46 IFM In (24) =1 THEN 

47 CALLP"36TOX" 

48 ELSE'(6) 

49 ENDIF'(6) 

50 * LARB2 

51 END 

52 *LAB3 

53 END 


3. 不 良品 在 1# 工 位 的 向 废品 区 的 转运 程序 31TOX 

不 良品 在 2# ~6# 工 位 向 废品 区 的 转运 程序 与 此 类 似 。 
(1) 流程 图 如 图 22-8 所 示 。 

(2) 程序 可 参见 “31TOX”。 


31TOFP2 装 料 程序 


N 


N 
1 工 位 有 料 无 料 判断 31 TOFP1 装 料 程序 
Y 
区 
N 
31 TOFP3 装 料 程序 


*31TOFEIP 


END 
2 工 位 有 料 无 料 判断 


END 
蜂 鸣 提 示 取 笠 


END 


图 22-8 不 良品 在 1# 工 位 时 向 废品 区 的 转运 流程 图 


22.3.7 宇 程 序 子 程序 汇总 表 


由 以 上 的 分 析 可 知 ,即使 看 似 简 单 的 搬运 测试 程序 ,也 可 以 分 解 成 许多 子 程序 。 对 应 于 
复杂 的 程序 流程 ,将 一 段 固定 的 动作 编制 为 子 程序 是 一 种 简单 实用 的 编程 方法 。 表 22-6 是 


程序 汇总 表 。 
表 22-6 主 程序 子 程序 汇总 表 
序 号 程序 名 称 程 序 号 功 能 上 级 程序 
光 主 程序 MAIN 
第 1 级 子 程序 
2 上 料 子 程序 SL MAIN 
s 务 料 子 程序 XL MAIN 
4 不 良品 处 理 程序 BULP MAIN 
报警 程序 BAOJ MAIN 
第 2 级 子 程序 上 料 子 程序 所 属 子 程序 
3 输送 带 到 1 工 位 10TO11 3 
6 输送 带 到 2 工 位 10TO12 SE 
‘ 输送 带 到 3 工 位 10TO13 SL 
8 输送 带 到 4 工 位 10TO14 SL 
9 输送 带 到 5 工 位 10TO15 出 
10 输送 带 到 6 工 位 10TO16 SI. 
第 2 级 子 程序 ” 印 料 子 程序 所 属 子 程序 
11 1 工 位 到 输送 带 21TO20 XL 
12 2 工 位 到 输送 带 22TO20 XL 
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续 表 
序 号 程序 名 称 程 序 号 上 级 程序 

13 3 工 位 到 输送 带 23TO20 至 

14 4 工 位 到 输送 带 24TO20 XE 

15 5 工 位 到 输送 带 25TO20 XL 

16 6 工 位 到 输送 带 26TO20 XE 

第 2 级 子 程序 不 良品 处 理 程序 所 属 子 程序 

不 良品 从 1 工 位 

bf Nn 31TOX BULP 
不 良品 从 2 工 位 

18 训 六 入 让 习 32TOX BULP 
不 良品 从 3 工 位 

19 相 六 祖 主 科 33TOX BULP 
不 良品 从 4 工 位 

20 凡 北 入 生 科 34TOX BULP 
不 良品 从 5 工 位 

21 科 北 机 让 入 35TOX BULP 
不 良品 从 6 工 位 

22 36TOX BULP 
转 其 他 工 位 
不 良品 从 1 工 位 

23 说 皮 训 区 性 内 31TOFP BULP 
不 良品 从 2 工 位 

24 ee 32TOFP BULP 
不 良品 从 3 工 位 

25 et ep 33TOFP BULP 
不 良品 从 4 工 位 

26 和 34TOFP BULP 
不 良品 从 5 工 位 

27 5TOFP BULP 
转 废品 区 程序 Wi 
不 良品 从 6 工 位 

28 和 民生 所 生计 36TOFP BULP 

第 3 级 子 程序 

不 良品 从 1 工 位 

29 ee 31TO32 31TOX 
不 良品 从 1 工 位 

30 2 证 从 宪 认 31TO33 31TOX 
不 良品 从 1 工 位 

31 人 和 31TO34 31TOX 
不 良品 从 1 工 位 

32 和 人 31TO35 31TOX 
不 良品 从 1 工 位 

33 人 晤 证 31TO36 31TOX 

34 丰 民 后 外 2 工 位 32TO31 32TOX 


转 1 工 位 程序 


续 表 


程序 名 称 程 序 号 上 级 程序 
35 0 32TO33 32TOX 
36 pe 32TO34 32TOX 
37 ee 32TO35 32TOX 
38 Rae 32TO36 32TOX 
39 ee 33TO31 33TOX 
40 et 33TO32 33TOX 
41 a 33TO34 33TOX 
42 oe 33TO35 33TOX 
43 人 33TO36 33TOX 
44 edie 34TO31 34TOX 
45 人 34TO32 34TOX 
46 人 34TO33 34TOX 
47 eee 34TO35 34TOX 
48 ee 34TO36 34TOX 
49 ee 35TO31 35TOX 
50 ee 35TO32 35TOX 
51 ee 35TO33 35TOX 
52 ee 35TO34 35TOX 
53 ne 35TO36 35TOX 
54 0 36TO31 36TOX 
55 ee 36TO32 36TOX 
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续 表 
序 号 程序 名 称 程 序 号 上 级 程序 

56 ge 36TO33 36TOX 

57 ee 36TO34 36TOX 

58 Ra ng 36TO35 36TOX 

59 1 自作 31TOFP1 31TOFP 
60 0 ; 和 31TOFP2 31TOFP 
61 人 ， 天 位 31TOFP3 31TOFP 
62 R 和 = 32TOFP1 32TOFP 
63 人 + 32TOFP2 32TOFP 
64 es ee : 人 33TOFP3 32TOFP 
65 ee Ee 33TOFPI1 33TOFP 
66 Ti 33TOFP2 33TOFP 
67 ee - TE 33TOFP3 33TOFP 
68 ee ， 工 位 34TOFP1 34TOFP 
69 Ra 人 34TOFP2 34TOFP 
70 人 : < 34TOFP3 34TOFP 
eer ， 工 位 35TOFP1 35TOFP 
72 ee , -i 35TOFP3 35TOFP 
73 ee . 二 化 36TOFP3 35TOFP 
74 Ce 1 工作 36TOFP1 36TOFP 
75 ， 3 i 36TOFP3 36TOFP 
76 站 民 汪 内 36TOFP3 36TOFP 


转 废品 区 3 


22.4 结 束 语 


(1) 在 工件 检测 项 目 中 ,编程 的 主要 问题 不 是 编制 搬运 程序 ,而 是 建立 一 个 优化 的 程序 
流程 。 因 此 在 进行 程序 编程 初期 ,要 与 设备 制造 商 的 设计 人 员 反 复 商讨 工艺 流程 ,在 确认 一 
个 优化 的 工作 流程 后 ,再 着 手 编制 流程 图 和 后 续 程 序 。 

(2) 对 每 一 段 固定 的 动作 必须 将 其 编制 为 子 程序 ,以 简化 编程 工作 和 有 利于 对 主 程序 
的 分 析 。 

(3) 柔性 控制 技术 在 将 工件 压 人 检测 槽 时 是 关键 技术 。 如 果 工 件 没有 紧密 放置 在 检测 
槽 内 ,会 影响 检测 结果 。 


22.5 需要 思考 的 问题 


(1) 在 主 程序 中 有 几 个 二 级 子 程序 ? 几 个 三 级 子 程序 ? 

(2) 本 案例 的 处 理 流 程 是 最 佳 流程 吗 ? 能 否 提 出 别 的 处 理 流程 ? 
(3) 为 什么 需要 初始 化 流程 ? 

(4) 什么 是 柔性 控制 技术 ? 

(5) 主 程序 是 循环 执行 程序 吗 ? 
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【学 习 目 的 】 
在 经 过 两 个 实际 案例 学 习 后 ,读者 会 感到 前 面 学 习 的 编程 指令 不 够 用 ,所 以 本 章 进行 纺 
程 指令 的 深度 学 习 。 


23.1 Spd(Speed) 一 一 速度 设置 指令 


1. 功能 
本 指令 设置 直线 插 补 、 圆 弧 插 补 时 的 速度 ,也 可 以 设置 最 佳 速度 控制 模式 ,以 mm/s 为 
单位 设置 。 
2. 指令 格式 
Spd < 速度 > 
Spd M_NSpd( 最 佳 速度 控制 模式 ) 
< 速度 >: 单位 为 mm/s。 
3. 指令 例句 
Spd 100 ' 一 一 设置 速度 = 100mm/s 
Mvs P1 ' 一 一 前 进 到 Pl 点 
Spd M_NSpd' 一 一 设置 初始 值 (最 佳 速度 控制 模式 ) 
Mov P2' 一 一 前 进 到 P2 点 
Mov P3' 一 一 前 进 到 P3 点 
Ovrd 80' 一 一 设置 速度 倍率 = 80% 
Mov P4' 一 一 前 进 到 P4 点 
Ovrd 100 ' 一 一 设置 速度 倍率 = 100% 


4. 说 明 
(1) 实际 速度 = 操作 面板 倍率 XX 程序 速度 倍率 X Spd。 
(2) M_NSpd 为 初始 速度 设 定 值 (通常 为 10 000)。 


设置 关节 轴 旋 转速 度 的 倍率 


oueewb 


23.2 JOvrd 


1. 功能 
本 指令 用 于 设置 以 关节 轴 方式 运行 时 的 速度 倍率 。 


2. 指令 格式 

Jovrd < 速度 倍率 > 

3. 指令 例句 

1 JOvrd 50 ' 一 一 设置 关节 轴 运 行 速度 倍率 =50s% 。 


2 ”Mov P1 ' 一 一 前 进 到 P1 点 。 
3 JOvrd M_NJOvrd' 一 一 设置 关节 轴 运 行 速度 倍率 为 初始 值 。 


23.3 Accel 设置 加 减速 阶段 的 “加 减速 度 的 倍率 ” 
1. 功能 

设置 加 减速 阶段 的 “加 减速 度 的 倍率 ”( 注 意 不 是 速度 倍率 ) 。 

2. 指令 格式 

Accel < 加 速度 倍率 >,< 减 速度 倍 率 >,< 圆 弧 上 升 加 减速 度 倍率 >,< 圆 弧 下 降 加 减速 度 倍率 > 

3. 指令 格式 说 明 


(1) < 加 减速 度 倍率 > 一 一 用 于 设置 加 减速 度 的 “倍率 ”。 
(2) < 圆 弧 上 升 加 减速 度 倍率 > 一 一 对 于 Mva 指令 ,用 于 设置 圆 弧 段 加 减速 度 的 “倍率 ”。 
4. 指令 例句 


1 Accel 50,100' 一 一 假设 标准 加 速 时 间 为 0.2s, 则 加 速度 阶段 倍率 = 50% , 即 0.4s。 减 速度 阶段 倍 
率 =100%, 即 0.2s。 

2 Mov Pl' 前 进 到 Pl 点 。 

3 ”Accel 100,100' 一 一 假设 标准 加 速 时间 为 0.2s, 则 加 速度 阶段 倍率 = 100% , 即 0.2s。 减 速度 阶段 
倍率 =100%, 即 0.2s。 

4 Mov P2' 前 进 到 P2 点 。 

5 Def Arch 1, 10,10,25,25,1,0,0' 一 一 定义 圆 弧 。 

6 Accel 100,100, 20,20,20, 20' 一 一 设置 圆 弧 上 升 下 降 阶 段 加 减速 度 倍率 。 

7 Mva P3,1' 一 一 前 进 到 P3 点。 


23.4 Cmp Jnt(Comp Joint) 指定 关节 轴 


进入 “柔性 控制 状态 ” 


1. 功能 
本 指令 用 于 指定 关节 轴 进 入 柔性 控制 状态 。 
2. 指令 格式 


Cmp Jnt < 轴 号 > 


< 轴 号 > 一 一 轴 号 用 一 组 二 进 制 编码 指定 。&B000000 对 应 654321 轴 。 
3. 指令 例句 


第 
1 Mov P1' 一 一 前 进 到 Pl 点 。 23 
2 CmpG 0.0,0.0,1.0,1.0, ，，，' 一 一 指定 柔性 控制 度 。 章 
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3 Cmp Jnt,&B11 指定 1 轴 、J2 轴 进 入 柔性 控制 状态 。 
4 Mov P2' 一 一 前 进 到 P2 点 。 
5 ”HOpen 1 ' 一 一 抓 手动 作 。 
6 Mov Bl1' 前 进 到 P2 点 。 
7 Cmp Off ' 一 一 返回 常规 状态 。 
23.5 Cmp Pos 指定 伺服 轴 进 入 “柔性 
控制 工作 模式 ” 
1. 功能 
本 指令 以 直角 坐标 系 为 基准 ,指定 伺服 轴 (CBAZYX)? 进 入 柔性 控制 工作 模式 。 
2. 指令 格式 


Cmp ”Pos,< 轴 号 > 


< 轴 号 >: 用 一 组 二 进 制 编码 指定 。&&B000000 对 应 CBAZYX 轴 。 
3. 指令 例句 


Mov P1' 一 一 前 进 到 Pl 点 。 
[+ 指定 柔性 控制 度 。 
Cmp Pos, &B011011" 设置 X,Y,A,B 轴 进 入 柔性 控制 模式 。 
Mvs P2" 前 进 到 Pl 点 。 

M_Out(10) = 1 ' 一 一 指令 输出 端子 10 = ON。 

Dly 1. 0' 一 一 暂停 1s。 

HOpen 1 ' 一 一 抓 手动 作 。 

Mvs， 100 ' 一 一 后 退 100。 

Cmp Off ' 一 一 返回 常规 状态 。 


吕 owaouewnb 


23.6 Cmp Tool 指定 伺服 轴 进 入 “柔性 
空 制 工作 模式 ” 
1. 功能 


以 TOOL 坐标 系 为 基准 ,指定 伺服 轴 (CBAZYX) 进 入 柔性 控制 工作 模式 。 
2. 指令 格式 


Cmp ”Tool,< 轴 号 > 


< 轴 号 >: 轴 号 用 一 组 二 进 制 编码 指定 。&B000000 对 应 CBAZYX 轴 。 
3. 指令 例句 


1 Mov Pl1' 一 一 前 进 到 Pl 点 。 

2 O65,.0.5 L005 Od 指定 柔性 控制 度 。 

3 ”Cmp Tool，&B011011' 一 一 指定 TOOL 坐标 系 中 的 X,Y, A,B 轴 进 入 柔性 控制 工作 模式 。 
4 Mvs P2' 一 一 前 进 到 P2 点 。 

5 M_0ut(10) = 1 ' 一 一 指令 输出 端子 10 = ON。 

6 


Dly 1.0 一 一 暂停 1s。 


7 ”HOpen 1 ' 一 一 抓 手动 作 。 
8 Mvs，- 100' 一 一 后 退 100。 
9 ”Cmp Off ' 一 一 返回 常规 状态 。 


23.7 Cmp Off 一 一 解除 机 器 人 柔性 控制 工作 模式 


1. 功能 
本 指令 用 于 解除 机 器 人 柔性 控制 工作 模式 。 
2. 指令 格式 


Cmp Off 


3. 指令 例句 


1 Mov Pl1' 一 一 前 进 到 Pl 点 。 

2 Cap6 0.5, 0.5, 1,0, 0.5, 0.5, , ,° 指定 柔性 控制 度 。 

3 Cmp Tool, &B011011 -—-—---— ' 指 定 TooL 坐标 系 中 的 X,Y, A,B 轴 进 入 柔性 控制 工作 模式 。 
4 Mvs P2' 一 一 前 进 到 P2 点 。 

5 M_out(10) = 1 ' 一 一 指令 输出 端子 10 = ON。 

6 

i 

8 
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Dly 1. 0' 一 一 暂停 1s。 

HOpen 1 ' 一 一 抓 手动 作 。 

Mvs，- 100 ' 一 一 后 退 100。 

Cmp Off ' 一 一 机 器 人 柔性 控制 工作 模式 = OFF。 


23.8 ”CmpG (Composition Gain) 一 一 设置 


柔性 控制 时 各 轴 的 增益 
1. 功能 
本 指令 用 于 设置 柔性 控制 时 各 轴 的 柔性 控制 增益 。 
2. 指令 格式 


1) 直角 坐标 系 
CnmpG [<X 轴 增益 >] [<Y 轴 增益 >] [<z 轴 增益 >] [<A 轴 增益 >] [<B 轴 增益 >] [<C 轴 增益 >] 
2) 关节 型 


Cmp6 [<J1 轴 增 益 >] [<J2 轴 增 益 >] [<J3 轴 增 益 >] [<J4 轴 增益 >] [<J5 轴 增 益 >] [<J6 轴 

增益 >] 

3) 说 明 

[<x*x 轴 增 益 >]: 用 于 设置 各 轴 的 柔性 控制 增益 。 常 规 状 态 二 1。 以 柔性 控制 增益 二 1 
为 基准 进行 设置 。 

3. 指令 例句 

CmpG ,0.5, ，，,， ,一 一 设置 z 轴 的 柔性 控制 增益 = 0.5, 省略 设 置 的 轴 用 "逗号 "分 隔 。 章 


第 23 日 一 一 编程 指 例 的 学 习 (5) 


30 日 学 烧 工 业 胡 器 人 


4. 说 明 

(1) 以 指令 位 置 与 实际 位 置 为 比例 , 像 弹 簧 一 样 产生 作用 力 ( 实 际 位 置 越 接近 指令 位 
置 ,作用 力 越 小 )。CmpG 就 相当 于 弹性 常数 。 

(2) 指令 位 置 与 实际 位 置 之 差 可 以 由 状态 变量 M_CmpDst 读 出 ,可 用 变量 M_CmpDst 
判断 动作 (例如 PIN 插入 ) 是 否 完成 。 

(3) 柔性 控制 增益 调 低 时 ,动作 位 置 精度 会 降低 ,因此 必须 逐步 调整 确认 。 

(4) 各 型 号 机 器 人 可 以 设置 的 最 低 * 柔 性 度 (增益 )” 如 表 23-1 所 示 。 


表 23-1 各 型 号 机 器 人 可 以 设置 的 最 低 * 柔 性 度 (增益 )” 


机 型 cmp pos cmp tool 指令 cmp jnt 指令 
RH-F 系列 0. 20,0. 20,0. 20,0. 20,0. 20,0. 20 | 0. 01,0. 01,0. 20,0. 01,1.00,1.00 
RV-F 系列 0.01,0.01,0.01,0.01,0.01,0.01 


23.9 Oadl(Optimal Acceleration) 对 应 抓 手 
及 工件 条 件 ,选择 最 佳 加 减速 模式 的 指令 


1. 功能 

本 指令 根据 对 应 抓 手 及 工件 条 件 ,选择 最 佳 加 减速 时 间 , 所 以 也 称 为 最 佳 加 减速 模式 选 
择 指令 。 

2. 指令 格式 


Oadl <On/Off> 


Oadl On: 最 佳 加 减速 模式 二 ON。 
Oadl OFF: 最 佳 加 减速 模式 二 OFF。 
3. 指令 例句 


0adl On ' 一 一 最 佳 加 减速 模式 = ON。 
Mov P1' 一 一 前 进 到 Pl 点 。 

LoadSet 1 ' 一 一 设置 抓 手 及 工件 类 型 。 
Mov P2' 一 一 前 进 到 P2 点 。 

HOpen 1 ' 一 一 抓 手动 作 。 

Mov P3' 一 一 前 进 到 P3 点 。 

HClose 1' 一 一 抓 手 动作 。 

Mov P4' 一 一 前 进 到 P4 点 。 

0adl Off ' 一 一 最 佳 加 减速 模式 = OFF。 
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23. 10 LoadSet(Load Set) 设置 抓 手 、 


工件 的 工作 条 件 


1. 功能 
在 实用 的 机 器 人 系统 配置 完毕 后 , 抓 手 及 工件 的 重量 、 大 小 和 重心 位 置 通过 参数 已 经 设 


置 完毕 ,如 图 23-1 所 示 。 本 指令 用 于 选择 不 同 的 抓 手 编号 及 工件 编号 。 


000 oo 
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图 23-1 使 用 参数 对 抓 手 及 工件 重量 及 重心 位 置 进行 设置 
2. 指令 格式 
LoadSet < 抓 手 编号 > < 工件 编号 > 


< 抓 手 编号 >: 0 一 8, 对 应 参数 HNDDAT0 一 8。 
< 工件 编号 >: 0 一 8 ,对 应 参数 WRKDAT0 一 8。 
3. 指令 例句 


0adl ON ' 一 一 最 佳 加 减速 模式 = ON。 

LoadSet 1, 1 ' 一 一 选择 1 号 抓 手 HNDDAT1 及 1 号 工件 WRKDRT1。 
Mov P1" 前 进 到 Pl 点 。 

LoadSet 0,0' 一 一 选择 0 号 抓 手 HNDDATO0 及 0 号 工件 WRKDATO。 
Mov P2 前 进 到 P2 点 。 

0adl 0ff' 一 一 最 佳 加 减速 模式 = OFF。 
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23.11 Prec(Precision) 选择 高 精度 模式 
有 效 或 无 效 , 用 以 提高 轨迹 精度 
1. 功能 


本 指令 选择 高 精度 模式 有 效 或 无 效 , 用 以 提高 轨迹 精度 。 
2. 指令 格式 


Prec < On/Off> 


Prec On 一 一 高 精度 模式 有 效 。 
Prec Off 一 一 高 精度 模式 无 效 。 
3. 指令 例句 


1 Prec 0n' 一 一 高 精度 模式 有 效 。 章 


第 23 日 一 一 编程 指 例 的 学 习 (5) 


30 日 学 凤 工 业 机 器 人 


Mvs P1" 
Mvs P2" 
Prec Off 
Mov P1" 


前 进 到 Pl 点 。 
前 进 到 P2 点 。 
高 精度 模式 无 效 。 
前 进 到 Pl 点 。 


MAROOND 


23.12 Torq(Torque) 转 矩 限制 指令 


1. 功能 
本 指令 用 于 设置 各 轴 的 转 矩 限制 值 。 
2. 指令 格式 


Torq < 轴 号 > < 转 矩 限制 率 > 


< 转 矩 限制 率 >: 额定 转 矩 的 百分数 。 
3. 指令 例句 


1 Def Act 1,M Fbd>10 GoTo x SUB1,S' 一 一 如 果实 际 位 置 与 指令 位 置 差 M_Fbd 大 于 10mm 则 跳 转 到 
子 程序 * SUB1。 

Act 1=1' 一 一 中 断 区 间 有 效 。 

Torq 3,10' 一 一 设置 J3 轴 的 转 矩 限制 倍率 =10s 。 

Mvs P1 ' 一 一 前 进 到 P1 点 。 

Mov P2' 一 一 前 进 到 P2 点 。 


wm mw 


100 * SUB1 ' 一 一 程序 分 支 标志 。 

101 Mov P_Fbc' 一 一 移动 回 当 前 位 置 。 
102 M_Out(10) = 1 ' 一 一 输出 端子 10 = ON。 
103 End' 一 一 结束 。 


23.13 JRC(Joint Roll Change) 
坐标 值 转换 指令 


旋转 轴 


1. 功能 

本 指令 功能 是 将 指定 旋转 轴 坐 标 值 加 / 减 360" 后 转换 为 当前 坐标 值 ( 用 于 原点 设置 或 
不 希望 当前 轴 受 到 形 位 标志 FLG2 的 影响 ) 。 

2. 指令 格式 


JRC <[ + ]< 数 据 >/ - < 数据 >/ 0> [< 轴 号 >] 


(1) [十 ]< 数 据 > 一 一 以 参数 JRCQTT 设 定 的 值 为 单位 增加 或 减少 的 “倍数 "。 如 果 未 
设置 参数 JRCQTT, 则 以 360" 为 单位 。 例 如 ,十 2 就 是 增加 720" ,一 3 就 是 减 1080"。 

(2) 如 果 < 数 据 > 二 0, 则 以 参数 JRCORG 设置 的 值 ,再 做 原点 设置 (只 能 用 于 “用 户 定 
义 轴 ”) 。 

(3) < 轴 号 > 一 一 指定 轴 号 (如 果 省 略 轴 号 , 则 为 J4 轴 ( 水 平 机 器 人 RH-F) 或 J6 轴 ( 垂 直 
机 器 人 RVH-F))。 


3. 指令 例句 


Mov P1 ' 一 一 移动 到 Pl 点 ,J6 轴 向 正 向 旋转 。 
JRC +1' 一 一 将 06 轴 当 前 值 加 360"。 

Mov P1 一 一 移动 到 Pl 点 。 

JRC +1' 一 一 将 J6 轴 当 前 值 加 360°。 

Mov Pl1 一 一 移动 到 Pl 点 。 

JRC -2 一 一 将 J6 轴 当 前 值 减 720"。 


4. 说 明 

(1) 本 指令 只 改变 对 象 轴 的 坐标 值 , 对 象 轴 不 运动 (可 以 用 于 设置 原点 或 其 他 用 途 ) 。 

(2) 由 于 对 象 轴 的 坐标 值 改 变 , 所 以 需要 预先 改变 对 象 轴 的 动作 范围 ,对 象 轴 的 动作 范 
围 可 设置 在 一 2340" 一 十 2340"。 

(3) 优先 轴 为 机 器 人 前 端的 旋转 轴 。 

(4) 未 设置 原点 时 系统 会 报警 。 

(5) 执行 本 指令 时 ,机 器 人 会 停止 。 

(6) 使 用 JRC 指令 时 务必 设置 下 列 参数 。 

Q@ JRCEXE = 1,JRC 指令 生效 。 

@ 用 参数 MEJAR 设置 对 象 轴 动 作 范 围 。 

@ 用 参数 JRCQTT 设置 JRC 1/ 一 1(JRC n/ 一 n) 的 动作 单位 。 

@ 用 参数 JRCORG 设置 JRC 0 时 的 原点 位 置 。 
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23. 14 Fine 定位 精度 
1. 功能 
定位 精度 用 脉冲 数 表示 , 即 指令 脉冲 与 反馈 脉冲 的 差 值 ,脉冲 数 越 小 ,定位 精度 
越 高 。 
2. 指令 格式 
Fine < 脉冲 数 >,< 轴 号 > 
3. 说 明 


< 脉冲 数 >: 表示 定位 精度 。 用 常数 或 变量 设置 。 
< 轴 号 >: 设置 轴 号 。 
4. 程序 样 例 


Fine 300 一 一 设置 定位 精度 为 300 脉冲 。 全 轴 通 用 。 
Mov P1 ' 一 一 前 进 到 P1 点 。 

Fine 100，2 一 一 设置 第 2 轴 定 位 精度 为 100 脉冲 。 
Mov P2 ' 一 一 前 进 到 P2 点 。 

Fine 0，5 一 一 定位 精度 设置 无 效 。 

Mov P3' 一 一 前 进 到 P3 点 。 

Fine10 0 ' 一 一 定位 精度 设置 为 100 脉冲 。 

Mov P4 ' 一 一 前 进 到 P4 点 。 
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第 23 日 一 一 编程 指 例 的 学 习 (5) 


坤 号 溃 


30 日 学 烧 工 业 夫 器 人 


ls 


23.15 FineJ 设置 关节 轴 的 旋转 定位 精度 


功能 


本 指令 设置 关节 轴 的 旋转 定位 精度 。 


2. 


指令 格式 


Fine < 定位 精度 > J[< 轴 号 >] 


EE 


OI 


ls 


指令 例句 


Fine 1, J' 设置 全 轴 定位 精度 1 [deg]。 

Mov P1 一 一 前 进 到 P1 点 。 

Fine 0.5, J, 2' 一 一 设置 2 轴 定 位 精度 0.5 [deg] 。 
Mov P2' 前 进 到 P2 点 。 

Fine 0, J, 5 ' 一 一 设置 5 轴 定 位 精度 无 效 。 

Mov P3' 一 一 前 进 到 P3 点 。 

Fine 0, J' 一 一 设置 全 轴 定 位 精度 无 效 。 

Mov P4' 一 一 前 进 到 P4 点 。 


23. 16 ”Fine P 一 一 以 直线 距离 设置 定位 精度 


功能 


本 指令 以 直线 距离 设置 定位 精度 。 


2. 


指令 格式 


Fine < 直线 距离 >,P 


3. 


人 w N 


1, 


23.17 Servo(Servo) 


指令 例句 


Fine 1, P' 一 一 设置 定位 精度 为 直线 距离 lmm。 
Mov P1' 一 一 前 进 到 Pl 点 。 

Fine 0，P' 一 一 定位 精度 无 效 。 

Mov P2 ' 一 一 前 进 到 P2 点 。 


指令 伺服 电源 的 ONVOFT 


功能 


本 指令 用 于 使 机 器 人 各 轴 的 伺服 ON/OFF。 


2. 


指令 格式 


Servo< 0n/0ff >< 机 器 人 编号 > 


3. 


a 
2 


指令 例句 


Servo 0n' 伺服 = ON 
x L20:If M_Svo <>1 GoTo * LI20 ' 一 一 等 待 伺服 = ON 


3 SpdM NSpd' 
4 MovP1' 
5 Servo Off" 


设置 速度 
前 进 到 Pl 点 
伺服 = OFF 


23. 18 Reset Err(Reset Error) 报警 复位 
1. 功能 

本 指令 用 于 使 报警 复位 。 

2. 指令 格式 


Reset Err 


3. 指令 例句 


1 IfM Err=1 Then Reset Err' 


如 果 有 M_Err 报警 发 生 , 就 将 报警 复位 。 


23.19 Wth(With) 一 一 在 插 补 动作 时 附加 


处 理 的 指令 
1. 功能 
本 指令 为 附加 处 理 指令 。 附 加 在 插 补 指令 之 后 ,不 能 单独 使 用 。 
2. 指令 例句 


Mov P1 Wth M_Out(17) = 1 Dly ML + 2' 一 一 在 向 P1 点 移动 过 程 中 指令 输出 端子 17 = 0N, 输出 端子 17 = 
ON 的 时 间 为 ML + 2。 


3. 说 明 
(1) 附加 指令 与 插 补 指令 同时 动作 。 
(2) 附加 指令 动作 的 优先 级 如 下 : 


Com> Act > WthIf (Wth) 


23.20 ”WthIf(With If) 一 一 附加 处 理 指令 


在 插 补 动作 中 带 有 附加 条 件 的 附加 处 理 的 指令 。 
1. 功能 

本 指令 也 是 附加 处 理 指令 ,只 是 带 有 “判断 条 件 ”。 
2. 指令 格式 


Mov Pl WthIf < 判断 条 件 > < 处 理 > 


< 处 理 >: 处 理 的 内 容 有 赋值 .HLT、skip。 
3. 指令 例句 


Mov Pl WthIf M_In(17)=1, Hlt 一 一 在 向 Pl 点 移动 过 程 中 ,如 果 输 入 信号 17 = ON, 则 程序 暂停 。 


第 23 日 一 一 编程 指 例 的 学 习 (5) 


30 日 学 凤 工 业 机 器 人 


Mvs P2 WthIf M_ RSpd> 200, M_Out(17) = 1 D1Y MI + 2' 一 一 在 向 P2 点 移动 过 程 中 ,如 果 M_RSpd>200, 则 
指令 输出 端子 17 = ON, 输出 端子 17 = ON 的 时 间 为 M1 + 2。 

Mvs P3 WthIf M_Ratio> 15，M_Out(1) = 1 ' 一 一 在 向 P3 点 移动 过 程 中 ,如 果 M_Ratio> 15, 则 指令 输出 
端子 1 = ON。 


23. 21 CavChk On 一 一 “ 防 碰 撞 功 能 ”是 否 生 效 


1. 功能 
本 指令 用 于 设置 “ 防 碰撞 功能 "是否 生 效 。 
2. 指令 格式 


CavChk <On/off >[,< 机 器 人 CPU 号 >[,NOErr]] 


< On/Off > 一 一 On:“ 防 碰撞 "停止 功能 二 On; Of:“ 防 碰撞 ”停止 功能 一 Off。 
< 机 器 人 CPU 号 > 一 一 设置 机 器 人 编号 。 
[NOErr] 一 一 检测 到 “干涉 ”时 不 报警 。 


23.22 ”ColLvl(ColLevel) 一 一 设置 磁 撞 检测 量 级 


1. 功能 
本 指令 用 于 设置 碰撞 检测 量 级 。 
2. 指令 格式 


ColLvl] [<Jl1 轴 >] [<J2 轴 >] [<J3 轴 >] [<J4 轴 >][<J5 轴 >] [<J6 轴 >] 


< 本 一 J6 轴 >]: 设置 各 轴 碰 撞 检 测量 级 。 
3. 指令 例句 


ColLvl 80,80,80,80, 80,80,，' 一 一 设置 各 轴 碰 撞 检 测量 级 。 
ColChk on ' 一 一 碰撞 检测 有 效 。 

Mov P1' 一 一 前 进 到 Pl 点 。 

ColLvl ,50,50,,,,, ----— "设置 J2,03 轴 碰 撞 检 测量 级 。 
Mov P2， 前 进 到 P2 点 。 

Dly 0.2' 一 一 暂停 0.2s。 

ColChk Off ' 一 一 碰撞 检测 无 效 。 

Mov P3' 一 一 前 进 到 P3 点 。 
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23.23 Open 打开 文件 指令 
1. 功能 
本 指令 为 “启用 ” 某 一 文件 指令 。 
2. 指令 格式 


Open "< 文件 名 > ” [For < 模式 >] As [#]< 文 件 号 码 > 


(1) < 文件 名 >: 记叙 文件 名 。 如 果 使 用 * 通 信 端 口 ? 则 为 “通信 端口 名 ”。 
(2) < 模式 > 

INPUT 一 一 输入 模式 (从 指定 的 文件 里 读 取 数 据 ) 。 

OUPUT 一 一 输出 模式 。 

APPEND 一 一 搜索 模式 。 

“省 略 ” 一 一 如 果 省 略 模式 指定 , 则 为 搜索 模式 。 


E 
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指令 例句 1( 通 信 端 口 类 型 ) 


Open "COM1:" as #1' 一 一 指定 1# 通 信 口 COMDEV1( 传 人 的 文件 ) 作 为 #1 文件 。 

Mov P_01' 一 一 前 进 到 P_01 点 。 

Print #1,P_Curr' 一 一 将 当前 值 "(100. 00,200.00,300,00,400.00)(7,0)" 输出 到 #1 文件 。 
Input # 1,M1,M2,M3 ' 一 一 读 取 #1 文件 中 的 数据 "101. 00, 202. 00,303.00" 到 M1, M2, M3。 
P_01.X = M1' 一 一 赋值 

P_01.Y = M2' 一 一 赋值 

P_01.C= Rad(M3) ' 一 一 赋值 

关闭 所 有 文件 。 


Close' 


End' 一 一 程序 结束 


4. 


t 
2 
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1. 


指令 例句 2( 文 件 类 型 ) 


Open "temp. txt" For Append Rs #1' 一 一 将 名 为 "temp. txt "的 文件 定义 为 #1 文件 。 
Print #1，"abc" ' 一 一 在 #1 文件 上 写 "abc。 
Close #1 ' 一 一 关闭 #1 文件。 


23.24 Print 输出 数据 指令 


功能 


本 指令 为 向 指定 的 文件 输出 数据 。 


2. 


指令 格式 


Print  #< 文 件 号 > < 数据 式 1>,< 数 据 式 2 >,< 数 据 式 3> 
< 数据 式 > 一 一 可 以 是 数值 表达 式 , 位置 表达 式 , 字 符 串 表达 式 


3. 


1 
2 
3 
4 
5 
6 
7 
8 


指令 例句 1 


Open "temp. txt"” For APPEND Rs #1' 一 一 将 temp.txt 文件 视 作 #1 文件 开启 。 
MDATA = 150°" 设置 MDATA = 150。 
Print #1," xx*x Print TEST xx*x "" 
Print #1 一 一 输出 "换行 符 "。 
Print #1,"MDATA = ", MDATA' 
Print #1 一 一 输出 "换行 符 "。 

Print 打 1，" 类 关 关 关 关 关 关 关 关 关 关 关 关 关 关 "' 一 一 输出 字符 蝇 "” 关 关 关 关 关 关 关 关 关 尖 关 关 尖 闪光 关 关 关 关 关 关 关 关 关 关 关 关 


End' 一 一 结束 


向 #1 文件 输出 字符 串 " xxx Print TEST xxx"。 


输出 字符 串 "MDMTA = "之 后 ,接着 输出 MDATA 的 具体 数据 150。 


输出 结果 如 下 。 


xx¥ Print TEST xxx 第 
MDATA = 150 23 
关 关 关 关 关 关 关 尖 关 关 关 关 尖 关 关 关 章 


第 23 日 一 一 编程 指 例 的 学 习 (5) 


30 日 学 烧 工 业 机 器 人 


4. 说 明 

(1) Print 指令 后 为 “空白 ”, 即 表示 输出 换行 符 。 注 意 其 应 用 。 

(2) 字符 串 最 大 为 14 字符 。 

(3) 多 个 数据 以 逗号 分 隔 时 ,输出 结果 的 多 个 数据 之 间 有 空格 。 
(4) 多 个 数据 以 分 号 分 隔 时 ,输出 结果 的 多 个 数据 之 间 无 空格 。 
(5) 以 双 引 号 标记 “字符 串 ”。 

(6) 必须 输出 换行 符 。 


5. 例句 2 

1 M1=123.5' 一 一 赋值 

2 Pl=(130.5, - 117.2,55.1,16.2,0.0,0.0)(1,0) ' 一 一 赋值 
3 Print #1, "OUTPUT TEST”，M1 ，P1 ' 一 一 以 逗号 分 隔 。 
输出 结果 : 数据 之 间 有 空格 。 

OUTPUT TEST 123.5 (130.5, - 117.2,55.1,16.2,0.0,0.0)(1,0) 
6. 例句 3 


3 Print #1,"0UTPUT TEST" ; M1 ; P1 ' 一 一 以 分 号 分 隔 
输出 结果 : 数据 之 间 无 空格 。 
OUTPUT TEST 123.5(130.5, - 117.2,55.1,16.2,0.0,0.0)(1,0) 


7. 例句 4 
在 语句 后 面 加 逗号 或 分 号 ,不 会 输出 换行 结果 。 


3 ， Print #1,"0UTPUT TEST", ' 一 一 以 逗号 结束 。 
4 ”Print #1,M1; ' 一 一 以 分 号 结束 。 
5 Print #1,P1' 一 一 输出 Pl 位 置 数 据 。 


输出 结果 : 


OUTPUT TEST 123.5(130.5, -117.2,55.1,16.2,0.0,0.0)(1,0) 


23.25 Input 文件 输入 指令 


1. 功能 
从 指定 的 文件 读 取 “ 数 据 ” 的 指令 , 读 取 的 数据 为 ASCII 码 。 
2. 指令 格式 


Input #< 文 件 编号 >< 输 入 数据 存放 变量 >[< 输 入 数据 存放 变量 >] … 


(1) < 文件 编号 >: 指定 被 读 取 数 据 的 文件 号 。 
(2) < 输入 数据 存放 变量 >: 指定 读 取 数 据 存放 的 变量 名 称 。 
3. 指令 例句 


1 Open "temp.txt" For Input Rs #01" 


指定 文件 "temp. txt" 为 1 井 文件 。 


2 Input #1，CRBCS ' 一 一 读 取 1 井 文 件 : 读 取 时 从 "起 首 " 到 "换行 "为 止 的 数据 被 存放 到 变量 "CABC 
$"。( 全 部 为 ASCII 码 。) 


10 Close ##1' 一 一 关闭 1# 文 件 。 


4. 说 明 
如 果 1# 文 件 的 数据 为 


PRN MELFA, 125.75, (130.5, - 117.2,55.1,16.2,0,0)(1,0) CR 


指令 : 1 Input #1,C1$ ,M1,Pl 

则 : C1$ 王 MELFA 

M1=125.75 
Pl=(130.5,—117.2,55.1,16.2,0,0)(1,0) 


23. 26 Close 一 一 关闭 文件 


1. 功能 

将 指定 的 文件 (及 通信 口 ) 关 闭 。 
2. 指令 格式 

Close [#]< 文 件 号 > [[#< 文 件 号 >] 
3. 指令 例句 


1 Open "temp. txt”For Append Rs #1' 一 一 将 文件 temp. txt 作为 1# 文 件 打开 
2 Print #1，"abc" ' 一 一 在 1# 文 件 中 写 人 "abc" 
3 Close #1 “一 一 关闭 1# 文 件 


23. 27 ColChk (Col Check) 
检测 功能 有 效 无 效 


指令 碰撞 


1. 功能 

本 指令 用 于 设置 磁 撞 检测 功能 有 效 无 效 。 碰 撞 检测 功能 指 检测 机 器 人 手臂 及 抓 手 与 周 
边 设备 是 否 发 生 碰 撞 , 如 果 发 生 碰 撞 立 即 停止 ,减少 损坏 。 

2. 指令 格式 


ColChk On[NOErr]/Off 


(1) On: 碰撞 检测 功能 有 效 。 检 测 到 碰撞 发 生 时 ,立即 停机 ,并 发 出 1010 报警 。 同 时 
伺服 二 OFF。 

(2) Off: 碰撞 检测 功能 无 效 。 

(3) NOErr: 检测 到 碰撞 发 生 时 不 报警 。 

3. 指令 例句 1: 检测 到 碰撞 发 生 时 报警 


第 
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1 ColLvl 80,80,80,80,80,80,，' 一 一 设置 碰撞 检测 量 级 。 章 


第 33 日 一 一 编程 插 仿 的 学 习 (5) 


30 日 学 赚 


工业 机 器 人 


105 
106 


5. 


ColChk 0n' 一 一 碰撞 检测 功能 有 效 。 
Mov B1' 前 进 到 P1 点 。 
Mov P2 前 进 到 P2 点 。 
Dly 0.2 一 一 等 待 动 作 完 成 。 也 可 以 使 用 定位 精度 指令 Fine。 
ColChk Off 一 一 碰撞 检测 功能 无 效 。 
Mov P3" 前 进 到 P3 点 。 
.指令 例句 2: 检测 到 碰撞 发 生 时 ,使 用 中 断 处 理 


Def Act 1,M_ColSts(1) = 1 GoTo * HOME,S' 一 一 如 果 检 测 到 磁 撞 发 生 , 跳 转 到 "HOME" 行 。 
Act 1=1' 一 一 中 断 区 间 生 效 。 

ColChk On, NOErr 一 一 碰撞 检测 功能 = 0n。 
Mov P1 一 一 前 进 到 Pl 点 。 

Mov P2 一 一 前 进 到 P2 点 。 

Mov P3' 一 一 前 进 到 P3 点 。 

Mov P4' 一 一 前 进 到 P4 点 。 

ColChk off ' 一 一 碰撞 检测 功能 = Off 

Act 1 = 0' 一 一 中 断 区 间 结 束 。 

* HOME ' 一 一 程序 分 支 标志 

ColChk Off ' 一 一 碰撞 检测 功能 = Off 

Servo On“ 伺服 on 

PESC = P_ColDir(1) * ( - 2) ' 一 一 碰撞 回 退 点 。 
PDST =P_Fbc(1) + PESC ' 一 一 碰撞 回 退 点 计算 。 
Mvs PDST' 一 一 前 进 到 PDST 点 。 

Error 9100' 一 一 报警 


说 明 


(1) 碰撞 检测 是 指 机 器 人 在 移动 过 程 中 ,实际 转 矩 超出 理论 转 矩 达到 一 定量 级 后 , 则 判 
断 为 碰撞 ,机 器 人 紧急 停止 。 


图 


23-2 中 ,有 理论 转 矩 和 实际 检测 到 的 转 矩 。 如 果实 际 检测 到 的 转 矩 大 于 设置 的 转 矩 


值 ,就 报警 。 


检测 到 碰撞 (100% 时 ) 实际 转 矩 


转 矩 人 < 
Ce 100% 出 厂 值 + 侧 
检测 到 碰撞 (60% 时 ) 60% 
计算 转 矩 
检测 标准 + 侧 60% 
a 出 厂 值 - 侧 
检测 标准 - 侧 se 
时 间 


图 23-2 ”实际 转 抢 与 设置 的 检测 转 矩 量 级 之 间 的 关系 


(2) 碰撞 检测 功能 可 以 用 参数 COL 设置 。 


23.28 HOpen/HClose(Open/Close) 
一 一 抓 手打 开 / 关 闭 指令 


1. 功能 

本 指令 为 抓 手 的 ON/OFF 指令 ,用 于 控制 抓 手 的 ON/OFF ,实质 上 是 控制 某 一 输出 信 
号 的 ON/OFF, 所 以 在 参数 上 要 设置 与 抓 手 对 应 的 输出 信号 。 

2. 指令 格式 


HOpen < 抓 手 号 码 > 
HClose < 抓 手 号 码 > 


3. 指令 例句 


HOpen 1 " 


1 指令 抓 手 1 = ON。 
2 Dly 0.2' 一 一 暂停 0.2s。 

3 HClose1' 指令 抓 手 1 = OFF。 
4 

5 


Dly 0.2' 一 一 暂停 0. 2s。 
Mov PUP' 一 一 前 进 到 PUP 点 。 


23. 29 Error 一 一 发 出 报警 信号 的 指令 
1. 功能 
本 指令 用 于 在 程序 中 发 出 报警 指令 。 
2. 指令 格式 
Error < 报警 编号 > 


3. 指令 例句 1 

1 Error 9000 

4. 指令 例句 2 

4 If ML <> 0 Then * LERR' 一 一 如 果 Ma 不 等 于 0 , 则 跳 转 到 * LERR 行 。 
14 * LeRR' 程序 分 支 标志 。 


15 MERR = 9000 + M1 * 10' 一 根据 Ml 计算 报警 号 。 
16 Error MERR' 一 一 报警 。 


17 End' 程序 结束 。 
23.30 Skip 跳 转 指令 
1. 功能 
本 指令 的 功能 是 中 断 执行 当前 的 程序 行 , 跳 转 到 下 一 程序 行 。 
2. 指令 格式 第 
二 
Skip 章 


第 23 日 一 一 编程 指 例 的 学 习 (5) 


30 日 学 嵌 工 业 机 器 人 


3. 指令 例句 

1 Mov Pl WthIf M In(17) = 1,Skip' 
行 , 跳 到 下 一 程序 行 。 

2 If M_SkipCq=1 Then Ht' 一 一 如 果 发 生 了 skip 跳 转 , 则 程序 暂停 。 


如 果 执 行 MovP1 的 过 程 中 M_In(17) =1, 则 中 断 MovP1 的 执 


23.31 Wait(Wait) 等 待 指令 
1. 功能 
本 指令 功能 为 等 待 条 件 满足 后 执行 下 一 段 指令 。 这 是 常用 指令 。 
2. 指令 格式 


Wait < 数值 变量 >= < 常数 > 
< 数值 变量 > 一 一 数值 型 变量 ; 常用 的 有 输入 输出 型 变量 。 
3. 指令 例句 1: 信号 状态 


1 WaitM In(1)= 1' 一 一 与 *L10:If M_ In(1) = 0 Then GoTo *L10 功能 相同 。 
2 Wait M_In(3) = 0' 一 一 等 待 输入 端子 3 = OFF。 


4. 指令 例句 2: 多 任务 区 状态 

3 Wait M_Run(2) = 1 ' 一 一 等 待 任务 区 2 程序 启动 。 

5. 指令 例句 3: 变量 状态 

Wait M_01 = 100 “一 一 如 果 变 量 "M_01 = 100", 就 执行 下 一 行 。 


23.32 Clr(Clear) 


清 零 指令 
1. 功能 


本 指令 用 于 对 输出 信和 号、 局 部 变量 、 外 部 变量 及 数据 * 清 零 ”。 
2. 指令 格式 

Clr <TYPE> 

<TYPE > 一 一 清 零 类 型 。 

<TYPE >=1: 输出 信号 复位 。 

<TYPE >==2: 局 部 变量 及 数组 清 零 。 

<TYPE > 二 3: 外 部 变量 及 数组 清 零 。 但 公共 变量 不 清 零 。 
3. 指令 例句 1: 类 型 1 

Clr 1 ' 一 一 将 输出 信号 复位 。 

4. 指令 例句 2: 类 型 2 

Dim MA(10) 一 一 定义 数组 。 


Def Inte IVAL' 一 一 定义 变量 精度 。 
Clr 2' 一 一 MA(1) ~~MA(10) 及 变量 IVR 及 程序 内 局 部 变量 清 零 。 


5. 指令 例句 3: 类 型 3 
外 部 变量 及 数组 清 零 。 
6. 指令 例句 4: 类 型 0 


Cir 3" 


Clr 0° 


同时 执行 类 型 1 一 3 清 零 。 


23.33” ”END 一 一 程序 段 结束 指令 


1. 功能 
END 指令 在 主 程序 内 表示 程序 结束 。 在 子 程序 内 表示 子 程序 结束 并 返回 主 程序 。 
2. 指令 格式 


END 
3. 指令 例句 


1 Mov P1' 一 一 前 进 到 Pl 点 。 
2 ”GoSub * ABC' 一 一 调用 子 程序 。 
3 ”End' 一 一 主 程序 结束 。 


10 ”x ABC' 一 一 程序 分 支 标志 。 


11 M1 =1' 一 一 赋值 。 
12 ”Return 返回 。 
4. 说 明 


(1) 如 果 需 要 程序 中 途 停止 并 处 于 中 断 状态 应 该 使 用 HLT 指令 。 
(2) 可 以 在 程序 中 多 处 编制 END 指令 。 也 可 以 在 程序 的 结束 处 不 编制 END 指令 。 


23.34 For Next 循环 指令 
1. 功能 
本 指令 为 循环 指令 。 
2. 指令 格式 
For < 计数 器 > = < 初始 值 > To < 结束 值 > Step < 增 量 > 
Next < 计数 器 > 


(1) < 计数 器 > 一 一 循环 判断 条 件 。 
(2) Step < 增 量 > 一 一 每 次 循环 增加 的 数值 。 
(3) 指令 例句 : 求 1 一 10 的 和 。 


坤 号 溃 


第 23 日 一 一 编程 指 例 的 学 习 (5) 


30 日 学 烧 工 业 胡 器 人 


1 MSUM = 0 ' 一 一 设置 "MSUM = 0" 

2 For ML = 1 To 10' 一 一 设置 ML 从 1 到 10 为 循环 条 件 , 单 步 增 量 = 1 
3 MSUM = MSUM + M1 ' 一 一 计算 公式 

4 Next Ml 


4. 说 明 
(1) 循环 嵌 套 为 16 级 。 
(2) 跳出 循环 不 能 使 用 GOTO 语句 ,使 用 LOOP 语句 。 


子 程序 /中 断 程序 结束 及 返回 


23.35 Return 


1. 功能 
本 指令 是 子 程序 结束 及 返回 指令 。 
2. 指令 格式 


Return 一 一 子 程序 结束 及 返回 。 
Return < 返回 程序 行 指定 方式 > 
< 返回 程序 行 指 定 方 式 > 一 一 0: 返回 到 中 断 发 生 的 "程序 步 "。 
一 一 1: 返回 到 中 断 发 生 的 "程序 步 " 的 下 一 步 。 


3. 指令 例句 1: 子 程序 调用 


1 ' xx%MAINPROGRAM xxx 
2 ”GoSub * SUB_INIT' 一 一 跳 转 到 子 程序 * SUB_INIT 行 
3 ”Mov Pl1' 一 一 前 进 到 Pl 点 


100 ' xxx SUB INIT 关 尖 兴 
101 * SUB_INIT ' 一 一 子 程序 标记 

102 PSTRRT = P1 ,一 一 设置 

103 M100 = 123' 一 一 赋值 

104 Return 1' 一 一 返回 到 " 子 程序 调用 指令 "的 下 一 行 ( 即 第 3 步 ) 


4. 指令 例句 2: 中 断 程序 调用 


1 Def Act 1,M_In(17) = 1 GoSub x Lact ' 一 一 定义 Act 1 对 应 的 中 断 程序 
2 Act 1=1' 一 一 中 断 区 间 生 效 


10 * Lact' 一 一 程序 分 支 标志 

11 act 1=0' 一 一 中 断 区 间 结 束 

12 M_Timer(1) = 0' 一 一 赋值 

13 Mov P2 一 一 前 进 到 P2 点 

14 Wait M_In(17) = 0 一 一 等 待 

15 Act 1 = 1 一 一 中 断 区 间 生 效 

16 Return 0 ' 一 一 返回 到 发 生 "中 断 " 的 单 步 

5. 说 明 

以 GoSub 指令 调用 子 程 序 , 必 须 以 Return 作为 子 程序 的 结束 。 


23.36 Label 


标签 .指针 


1. 功能 
“标签 ”用 于 为 程序 的 分 支 处 做 标记 ,属于 程序 结构 流程 用 标记 。 
2. 指令 例句 


1 *SUBl' * SUB1 即 是 "标签 "。 

2 If ML =1 Then GoTo x SUB1' 一 一 判断 语句 

3 *LBL1:If M_In(19) = 0 Then GoTo x*LBL1' 一 一 判断 语句 
* LBL1 即 是 标签 。 


23.37 Tool(Tool) 


Tool 数据 的 指令 


1. 功能 

本 指令 用 于 设置 Tool 的 数据 ,适用 于 双 抓 手 的 场合 ,Tool 数据 包括 抓 手 长 度 、 机 械 I/F 
位 置 、 形 位 。 

2. 指令 格式 

Tool <Tool 数据 > 

< Tool 数据 > 一 一 以 位 置 点 表达 的 Tool 数据 。 

3. 指令 例句 1 

直接 以 数据 设置 。 

1 Tool (100,0,100,0,0,0) 一 一 设置 一 个 新 的 Tool 坐标 系 。 新 坐标 系 原点 X= 100mn,Z = 100mm。 

(实际 上 变更 了 "控制 点 "。) 

2 Mvs P1 ' 一 一 前 进 到 P1 点 。 

3 Tool P_NTool ' 一 一 返回 初始 值 (机 械 IF, 法 兰 面 ) 。 

4. 指令 例句 2 

以 直角 坐标 系 内 的 位 置 点 设置 。 

1 Tool PTL01 ' 一 一 设置 一 个 新 的 Tool 坐标 系 。 以 PTL01 为 原点 。 

2 Mvs P1 ' 一 一 前 进 到 P1 点 。 

如 果 PTL01 位 置 坐标 为 (100, 0, 100, 0, 0, 0, 0, 0) , 则 与 指令 例句 1 相同 。 

5. 说 明 

(1) 本 指令 适用 于 双 抓 手 的 场合 。 每 个 抓 手 的 控制 点 不 同 。 单 抓 手 的 情况 下 一 般 使 用 
参数 MEXTL 设置 即 可 。 

(2) 使 用 Tool 指令 设置 的 数据 存储 在 参数 MEXTL 中 。 
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(3) 可 以 使 用 变量 M_Tool, 将 METL1~4 设置 到 Tool 数据 中 。 章 
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23.38 Base 


设置 一 个 新 的 “世界 坐标 系 ” 


1. 功能 
本 指令 通过 设置 偏 置 坐标 建立 一 个 新 的 世界 坐标 系 。 偏 置 坐标 为 以 世界 坐标 系 为 基准 
观察 到 的 基本 坐标 系 原点 的 坐标 值 ,参看 图 23-3。 


ZW BASE (50, 100, 0, 0, 0, 90) 


Xw 基本 坐标 系 
Xb、Yb、Zb 


图 23-3 世界 坐标 系 与 基本 坐标 系 的 关系 
2. 指令 格式 


Base < 新 原点 > 一 一 用 新 原点 表示 一 个 新 的 世界 坐标 系 。 
Base < 坐标 系 编号 > 一 一 用 坐标 系 编号 选择 一 个 新 的 世界 坐标 系 。 


0: 系统 初始 坐标 系 P_NBase。P_NBase 二 0, 0, 0, 0, 0, 0。 
1 一 8: 工件 坐标 系 1 一 8 。 
3. 指令 例句 1 


1 Base (50,100, 0,0,0,90) 一 一 以 新 原点 设置 一 个 新 的 世界 坐标 系 。 这 个 点 是 基本 坐标 系 原点 在 
新 坐标 系 内 的 坐标 值 。 

2 Mvs P1 ' 一 一 前 进 到 P1 点 。 

3 ”Base P2 一 一 以 P2 点 为 基点 设置 一 个 新 的 世界 坐标 系 。 

4 Mvs Pl1' 一 一 前 进 到 Pl 点 。 

5 Base 0 ' 一 一 返回 初始 世界 坐标 系 。 


4. 指令 例句 2: 以 坐标 系 编号 选择 坐标 系 

Base 1 ' 一 一 前 进 到 Pl 点 。 选 择 1 号 坐标 系 WK1CORD。 
Mvs P1 ' 一 一 前 进 到 P1 点 。 

Base 2 一 一 前 进 到 P1 点。 选择 2 号 坐标 系 KE2CORD。 


Mvs P1 ' 一 一 前 进 到 P1 点 。 
Base 0 ' 一 一 前 进 到 Pl 点 。 选 择 初始 世界 坐标 系 。 


5. 说 明 
(1) 新 原点 数据 是 从 新 世界 坐标 系 观 察 到 的 基本 坐标 系 原 点 的 位 置 数据 , 即 基 本 坐标 
系 在 新 世界 坐标 系 中 的 位 置 。 


um wb 


(2) 使 用 当前 位 置 点 建立 一 新 世界 坐标 系 时 可 以 使 用 Base Inv(P1) 指 令 ( 必 须 对 Pl 点 
进行 道 变换 )。 


23.39 XLoad(X Load) 一 一 加 载 程 序 指令 


1. 功能 
加 载 程序 。 多 程序 时 ,选择 任务 区 并 加 载 程序 号 。 
2. 指令 格式 


XLoad < 任务 区 号 > < 程序 号 > 
3. 指令 例句 


1 If M Psa(2) = 0 Then x LblRun' 一 一 判断 执行 语句 。 

2 ”XLoad 2,"10" 一 一 在 任务 区 2 加 载 10 号 程序 。 

3 x#*L30:If C_Prg(2)<>"10" Then GoTo * L30' 一 一 判断 执行 语句 。 
4 XRun 2 一 一 任务 区 2 启动 运行 。 

5 Wait M_Run(2) = 1' 一 一 等 待 。 

6 ”x LblRun' 一 一 程序 分 支 标志 。 


23.40 XRun(X Run) 一 一 多 任务 工作 时 的 
程序 启动 指令 
1. 功能 


本 指令 用 于 在 多 任务 工作 时 指定 “任务 区 号 ”和 “程序 号 ”及 “运行 模式 ”。 
2. 指令 格式 


XRun < 任务 区 号 > "< 程序 名 >” < 运行 模式 > 
< 运行 模式 > 一 一 设置 程序 "连续 运行 "或 " 单 次 运行 "。 
< 运行 模式 > = 0: 连续 运行 。 
< 运行 模式 >= 1: 单 次 运行 。 
3. 指令 例句 1 
1 XRun 2,"1"" 指令 运行 任务 区 2 内 的 1 号 程序 。 连 续 运行 模式 。 
2 Wait M_Run(2) =1' 一 一 等 待 运 行 任务 区 2 内 的 1 号 程序 启动 完成 。 


4. 指令 例句 2 


1 XRun 3,， "2",1' 一 一 指令 运行 任务 区 3 内 的 2 号 程序 。 单 次 运行 模式 。 
2 Wait M_Run(3) = 1 ' 一 一 等 待 运行 任务 区 3 内 程序 启动 完成 。 


5. 指令 例句 3 


1 XLoad 2, "1"' 一 一 在 任务 区 2 内 加 载 #1 程序 。 
2 xLBL: If C_Prg(2)<>"1" Then GoTo * LBL' 一 一 等 待 加 载 完 毕 。 
3 ”XRun 2 ' 一 一 指令 运行 任务 区 2 内 程序 。 


第 23 日 一 一 编程 指 例 的 学 习 (5) 
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6. 指令 例句 4 


1 XLoad 3，"2"' 一 一 在 任务 区 3 内 加 载 #2 程序 。 
2 *ILBL:If C_Prg (3)<>"2" Then GoTo * LBL' 一 一 等 待 加 载 完毕 。 
指令 运行 任务 区 3 内 程序 单 次 运行 模式 。 


本 指令 中 ,程序 名 ”必须 要 用 双 引 号 。 


23. 41 XStp(X Stop) 一 一 多 任务 工作 时 的 


3 XRmn3,71” 


程序 停止 指令 
1. 功能 
本 指令 为 多 任务 工作 时 的 程序 停止 指令 ,需要 指定 任务 区 号 。 
2. 指令 格式 
XStp < 任务 区 号 > 
3. 指令 例句 
1 XRun 2 指令 运行 任务 区 2 内 的 程序 


10 XStp 2 ' 一 一 任务 区 2 内 的 程序 停止 。 
11 Wait M Wai(2)=1" 等 待 。 


20 XRun 2' 一 一 指令 运行 任务 区 2 内 的 程序 。 
23.42 XRst(X Reset) 一 一 复位 指令 
1. 功能 
程序 复位 指令 ,用 于 多 任务 工作 时 指令 某 一 任务 区 程序 的 复位 。 
2. 指令 格式 
XRst < 任务 区 号 > 
3. 指令 例句 
1 XRun 2' 一 一 指令 任务 区 2 启动。 
2 Wait M_Run(2) = 1 一 一 等 待 任务 区 2 启动 完成 。 
10 XStp 2 ' 一 一 指令 任务 区 2 停止 。 


11 Wait M_Wai(2) = 1' 一 一 等 待 任务 区 2 停止 完成 。 


15 XRst 2 ' 一 一 指令 任务 区 2 内 的 程序 复位 。 
16 Wait M_Psa(2) =1' 一 一 等 待 任务 区 2 内 的 程序 复位 完成 。 


20 XRun 2 一 一 指令 任务 区 2 启动 。 
21 Wait M_Run(2) = 1 一 一 等 待 任务 区 2 启动 完成 。 


本 指令 必须 在 程序 暂停 状态 下 执行 ,在 其 他 状态 下 执行 会 报警 。 


23. 43 XCIlr(X Clear) 多 程序 工作 时 ， 
解除 某 任务 区 的 程序 选择 状态 


1. 功能 

多 程序 工作 时 ,解除 某 任务 区 的 程序 选择 状态 ,使 该 任务 区 处 于 可 以 重新 加 载 程序 的 
2. 指令 格式 
XClr < 任务 区 号 > 
3. 指令 例句 


1 XRun 2,"1" ' 一 一 运行 任务 区 2 内 的 1 号 程序 。 
10 XStp 2 ' 一 一 停止 任务 区 2 运行 。 
11 Wait M_Wai(2) = 1' 一 一 等 待 任务 区 2 中 断 启动 。 


12 XRst 2 一 一 解除 任务 区 2 程序 中 断 状态 。 
13 XClr 2 ' 一 一 解除 任务 区 2 程序 选择 状态 。 
14 End' 一 一 程序 结束 。 


指定 


23.44 GetM (Get Mechanism) 下 定 


获取 机 器 人 控制 权 


1. 功能 

本 指令 用 于 指定 机 器 人 的 控制 权 。 在 多 任务 控制 时 ,在 任务 区 ( 插 槽 )1 以 外 的 程序 要 
执行 对 机 器 人 控制 ,或 对 附加 轴 作为 用 户 设 备 控制 时 ,使 用 本 指令 。 

2. 指令 格式 


GetM ”< 机 器 人 编号 > 
< 机 器 人 编号 > 一 一 使 用 的 机 器 人 编号 。 


3. 指令 例句 1 


1 RelM' 一 一 解除 "机 器 人 控制 权 "。 这 样 可 以 从 任务 区 2 对 机 器 人 1 的 任务 区 1 程序 进行 控制 。 
2 XRun 2,"10"' 一 一 在 任务 区 2 选择 并 运行 10 号 程序 。 
3 Wait M_Run(2) =1' 一 一 等 待 任务 区 2 的 程序 启动 。 


任务 区 2 内 的 "10" 号 程序 : 


1 GetM 1' 一 一 取得 1 号 机 器 人 的 控制 权 。 

2 Servo 0n' 一 一 1 号 机 器 人 伺服 0n。 

3 Mov P1 一 一 前 进 到 P1 点 。 

4 Mvs P2 ' 一 一 前 进 到 P2 点 。 

5 P3=P_Curr' 一 一 设置 P3 点 为 当前 位 置 。 
6 ”Servo 0ff' 一 一 1 号 机 器 人 伺服 0ff。 

7 ”RelM' 一 一 解除 对 1 号 机 器 人 的 控制 权 。 

8 ”End' 一 一 程序 结束 。 


十 只 名 
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4. 说 明 

(1) 一 般 执行 单 任务 时 在 初始 状态 就 获得 对 机 器 人 1 的 控制 权 , 所 以 不 使 用 本 指令 。 

(2) 不 能 使 多 个 程序 同时 获得 对 机 器 人 1 的 控制 权 , 所 以 对 于 任务 区 1 以 外 的 程序 ,要 
对 机 器 人 1 进行 控制 必须 按 以 下 步骤 执行 。 

g@ 在 任务 区 1 的 程序 中 ,解除 对 机 器 人 1 的 控制 权 。 

@ 在 其 他 任务 区 的 程序 中 ,使 用 GetM 1 获得 对 机 器 人 1 的 控制 权 。 

已 经 获得 对 机 器 人 1 的 控制 权 的 程序 中 ,再 发 GetM 1 指令 会 报警 。 


23.45 RelM(Release Mechanism) 一 一 解除 
机 器 控制 权 


1. 功能 

在 多 任务 工作 时 ,为 了 从 其 他 任务 区 ( 插 槽 ) 对 任务 区 1 进行 控制 ,需要 解除 任务 区 1 的 
控制 权 。 本 指令 就 是 解除 控制 权 指令 。 

2. 指令 格式 


Relm 


3. 指令 例句 
先 在 任务 区 1 内 解除 控制 权 , 青 运行 任务 区 2 的 程序 ,从 任务 区 2 对 任务 区 1 的 程序 进 
行 控制 。 


1 RelM' 一 一 解除 任务 区 1 的 控制 权 。 
2 XRun 2,"10"' 一 一 指令 任务 区 2 内 运行 10 号 程序 。 
3 WaitM Run(2)=1" 等 待 任务 区 2 程序 启动 。 


任务 区 2 内 的 是 "10" 号 程序 : 


GetM 1 ' 一 一 获取 任务 区 1 控制 权 。 
Servo On * 伺服 On。 

Mov P1 ' 一 一 前 进 到 P1 点 。 

Mvs P2' 一 一 前 进 到 P2 点 。 

Servo Off" 伺服 Off。 
RelM' 一 一 解除 对 任务 区 1 的 控制 权 。 
End' 一 一 程序 结束 。 
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23. 46 ”Priority(Priority) 一 一 优先 执行 指令 


1. 功能 
本 指令 在 多 任务 时 使 用 .指定 各 任务 区 ( 插 槽 ) 内 程序 的 执行 行 数 。 
2. 指令 格式 


Priority < 执行 行 数 > [< 任务 区 号 >] 
< 执行 行 数 > 一 一 设置 执行 程序 的 行 数 。 


< 任务 区 号 > 一 一 任务 区 号 。 
3. 指令 例句 
任务 区 1 


10 Priority 3 


任务 区 2 


指定 执行 任务 区 1 内 的 程序 3 行 。( 如 果 省 略 任务 区 号 ,就 是 指 当前 任务 区 。) 


10 Priority 4' 一 一 指定 执行 任务 区 2 内 的 程序 4 行 。( 如 果 省 略 任务 区 号 ,就 是 指 当前 任务 区 。) 


动作 : 先 执行 任务 区 1 内 程序 3 行 ,再 执行 任务 区 2 内 程序 4 行 ,循环 执行 。 


23.47 需要 思考 的 问题 


(1) 如 何 执行 机 器 人 柔性 控制 ? 
(2) 如 何 执行 机 器 人 转 矩 控制 ? 
(3) 如 何 执行 input 指令 ? 

(4) 如 何 执 行 SKIP 指令 ? 
(5) 如 何 执行 循环 指令 ? 

(6) label 指令 有 什么 作用 ? 
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第 24 章 第 24 日 一 一 触摸 屏 在 机 器 人 上 的 应 用 


【学 习 目 的 】 

在 实际 工作 中 ,机 器 人 不 是 单一 的 在 工作 ,往往 需要 与 PLC、 触 摸 屏 、 上 位 机 一 同 工 作 。 
机 器 人 与 触摸 屏 联 合 使 用 的 方法 有 两 种 ,第 一 种 是 触摸 屏 连 接 在 PLC 上 ,PLC 再 与 机 器 人 
相连 。 第 二 种 是 触摸 屏 直 接 与 机 器 人 相连 。 第 二 种 方法 能 够 在 触摸 屏 上 直接 读 取 机 器 人 各 
种 工作 状态 变量 ,同时 也 可 以 节省 一 个 PLC。 本 章 学 习 触 摸 屏 直接 与 机 器 人 相连 的 方法 。 


24.1 概 述 


触摸 屏 ( 以 下 简称 GOT) 可 以 与 机 器 人 通过 以 太 网 直接 相连 。 通 过 GOT 可 以 直接 控 
制 机 器 人 的 启动 ,停止 ,选择 程序 号 ,设置 速度 倍率 ,监视 机 器 人 的 工作 状态 ,执行 JOG 操 
作 等 。 

本 章 以 三 萎 GOT 与 机 器 人 的 连接 为 例 , 介 绍 GOT 界面 的 制作 过 程 以 及 与 之 相应 的 机 
器 人 一 侧 的 参数 设置 。 在 GOT 界面 制作 中 使 用 MELSOFT GT Design 3 软件 (简称 
GT3)。 在 机 器 人 一 侧 使 用 RT ToolBox2 软件 (简称 RT) ,这些 软 件 在 三 菱 官 网 上 都 可 下 
载 。 在 下 文中 不 再 重复 提 及 。 

24.2 GOT 与 机 器 人 控制 器 的 连接 
及 通信 参数 设置 


24.2.1 GOT 与 机 器 人 控制 器 的 连接 
如 图 24-1 所 示 ,GOT 与 机 器 人 控制 器 可 以 通过 以 太 网 直接 连接 。 


GOT 
Ka 1 <Ethernet> 


由 
机 器 人 本 体 机 器 人 控制 器 


图 24-1 GOT 与 机 器 人 控制 器 的 连接 


24.2.2 GOT 机 种 选择 
使 用 GT 3 软件 ,在 图 24-2 中 ,选择 GS 系列 GOT。GS 系列 GOT 是 最 经 济 型 的 GOT。 


G521™™-W (800x480) 


GS2110-WTBD ”6S2107-WTBD 


软件 也 文件 夹 名 (P): 


语言 和 字体 设置 
标准 语言 (R): 


24-2 ”GOT 类 型 型 号 及 语言 设置 


24.2.3 GOT 一 侧 通信 参数 设置 
图 24-3 是 GOT 自动 默认 的 以 太 网 通信 参数 。 


及 商 (M): 二 机 z=] 
机 种 (E): MELSEC-Q, Q17nD/M -| 
以 汪 网 设置 (T) 
VE 1 标准 VFLB 太 同 ) 闵 CPUi 接 对 应 | 
驱动 程序 (D): [以 太 同 (MELSEC), Q17nNC, CRnD-700, 网 关 | 
Wa eonstotBeaea] py， _ 标 配 。 无 须 改变 


址 一 一 标 配 。 无 须 改变 


图 24-3 GOT 自动 默认 的 以 太 网 通信 参数 


在 图 24-4 下 方 , 是 对 GOT 所 连接 对 象 (机 器 人 ) 一 侧 通信 参数 的 设置 。 请 按照 图 24-4 
进行 设置 (注意 这 是 在 GOT 软件 上 的 设置 ) 方法 如 下 。 

(1) IP 地 址 必须 与 GOT 在 同一 网 段 .但 是 第 4 位 数字 必须 不 同 。 

(2) 必须 设置 “站 号 二 2”。 第 

(3) 设置 “端口 号 =5001”。 在 选择 GOT 所 连接 的 机 器 类 型 后 ,“ 端 口号 ”自动 改变 。 
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以 下 是 对 机 器 人 
以 太 网 参数 设置 


通讯 方式 
UDP 


端口 号 
5001 


了 地 址 
192.168.3.39 


端口 号 与 GOT 一 侧 相同 


图 24-4 从 GOT 软件 对 机 器 人 一 侧 以 太 网 通信 参数 的 设置 


24.2.4 机 器 人 一 侧 通信 参数 的 设置 


打开 机 器 人 软件 RT ToolBox2 ,设置 Ethernet 通信 参数 。 
(1) 单 击 “ 任 务 区 ”一 “参数 ”一 “通信 参数 ”>“Ethernet 设置 ,如 图 24-5 所 示 。 


| 和 白 男 TooL 
由 国 MELFA-3D Vision 
白 谢 yo smubtor 


图 24-5 打开 机 器 人 以 太 网 参数 设置 界面 


(2) 在 弹出 的 界面 上 ,进行 IP 地 址 设置 ,本 IP 地 址 是 机 器 人 一 侧 的 IP。 本 设置 必须 与 
图 24-6 相同 。 设 置 原则 也 是 IP 地 址 必须 与 GOT 在 同一 网 段 ,但 是 第 4 位 数字 必须 不 同 。 

(3) 设备 .端口 设置 。 

单 击 * 设 备 。 端口 ”, 弹 出 如 图 24-7 所 示 对 话 框 。 


192 . 168 . 3 . 


255 . 255 . 255 . 


192 .168 . 0 .254 


图 24-6 机 器 人 以 太 网 参数 设置 界面 


设备 是 指 与 机 器 人 连接 的 设备 , 即 GOT。 其 设置 就 是 对 GOT 通信 参数 设置 ,应 该 按 
GOT 一 侧 的 标准 参数 设置 ,如 图 24-7 所 示 。 


Re 设备 指 与 机 器 人 
a 通信 的 对 象 
| 设备 (D): OPT11 
自动 设 定 (C): 无 


模式 (M): 。 《NETMODE(1)) [@: 究 户 江 
也 地 址 (1): 。 (NETHSTIP(1)) 192 .168 .3 .18 
端 (P): (NETPORT(2) S00l 
协议 (T): 。 (CpRCE11) [到 数据 库 撞 


这 是 GOT 的 IP 


“端口 号 "是 GOT 
- 侧 的 端口 号 


结束 编码 (K): (CTERME11) 。 [GE CR 
分 本 (A): 。 (COMDEV) |[ 祭 过 出 
Co J my 


图 24-7 在 机 器 人 一 侧 对 GOT 以 太 网 参数 的 设置 画面 (设备 参数 设 定 ) 


设置 方法 如 下 。 

@ 设备 名 称 : OPT11。 

@ 模式 (NETMODE(1)): 选择 “客户 端 ”。 

@ IP 地 址 : 为 GOT 一 侧 IP。 

@ 端口 号 : GOT 一 侧 使 用 的 端口 。 

经 过 在 GOT 一 侧 及 机 器 人 一 侧 做 通信 参数 的 设置 , 连 上 以 太 网 线 后 ,就 可 以 进行 通 
信 了 。 


24.3 输入 输出 信号 界面 制作 


图 24-8 是 在 GOT 上 制作 的 “操作 屏 ” 界 面 ,该 界面 上 的 各 按键 都 是 “开关 型 "按键 ,对 应 
机 器 人 内 部 的 “输入 输出 信号 ”。 
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24.3.1 


机 器 人 操作 愤 


图 24-8 操作 屏 界 面 


GOT 器 件 与 机 器 人 I/O 地 址 的 对 应 关系 


在 机 器 人 一 侧 ,其 输入 信号 为 10000 一 18191 .输出 信号 为 10000 一 18191 ,用 于 与 GOT 


通信 使 用 。 
在 GOT 


还 需要 在 机 器 人 一 侧 通过 参数 进行 设置 。 


- 侧 ,器 件 U3E0-10000 一 10511 用 作 输 入 器 件 。 器 件 U3E1-10000 一 10511 用 
作 输 出 器 件 。 其 对 应 关系 如 表 24-1 和 表 24-2 所 示 。 


在 表 24-1 中 ,机 器 人 输入 信号 "对 应 的 功能 ?是 推荐 使 用 (用 户 可 自行 设置 ) ,这 些 功 能 


表 24-1 输入 信号 对 应 表 
网 推荐 对 应 的 功能 信号 
序 号 GOT 机 器 人 (int) 功能 参数 名 区 
U3E0-10000~ 
i 10000~18191 输入 点 范围 

1 U3E0-10000. b0 10000 
U3E0-10000. bl 10001 
3 U3E0-10000. b2 10002 
4 U3E0-10000. b5 10005 操作 权 IOENA 
5 U3E0-10000. b6 10006 启动 START 
6 U3E0-10000. b8 10008 程序 复位 SLOTINIT 
7 U3E0-10000. b9 10009 报警 复位 ERRRESET 
8 U3E0-10000. bl0 | 10010 伺服 ON SRVON 
9 U3E0-10000. bl1 | 10011 伺服 OFF SRVOFF 
10 U3E0-10000. bl2 | 10012 程序 循环 结束 CYCLE 
11 U3E0-10000. bl3 | 10013 回 退 避 点 SAFEPOS 
12 U3E0-10000. b15 | 10015 全 部 输出 信号 复位 OUTRESET 
13 U3E0-10001. b4 10020 选 定 程序 号 确认 PRGSEL 
14 U3E0-10001. b5 10021 选 定 速度 倍率 确认 OVRDSEL 
15 U3E0-10001. b6 10022 指令 输出 “程序 号 ” PRGOUT 
16 U3E0-10001. b7 10023 指令 输出 “程序 行 号 ”| LINEOUT 
17 U3E0-10001. b8 10024 指令 输出 “速度 倍率 ”| OVRDOUT 
18 U3E0-10001. b9 10025 指令 输出 “报警 号 ” ERROUT 
18 U3E0-10002 10032 一 10047 数据 输入 区 IODATA 


表 24-2 输出 信号 对 应 表 


推荐 对 应 的 功能 信号 
序 号 GOT 机 器 人 (out) 
功能 参数 名 称 
U3E1-10000~ 
U3E1-10511 10000 一 18191 

1 U3E1-10000. b0 10000 暂停 状态 STOP2 
2 U3E1-10000. bl 10001 控制 器 上 电 ON RCREADY 
3 U3E1-10000. b2 10002 远程 模式 状态 ATEXTMD 
4 U3E1-10000. b3 10003 示 教 模式 状态 TEACHMD 
5 U3E1-10000. b4 10004 示 教 模式 状态 ATTOPMD 
6 U3E1-10000. b5 10005 操作 权 王 ON IOENA 
7 U3E1-10000. b6 10006 自动 启动 =ON START 
8 U3E1-10000. b7 10007 STOP=ON STOPSTS 
9 U3E1-10000. b8 10008 可 重新 选择 程序 ”| SLOTINIT 
10 U3E1-10000. b9 10009 发 生 报警 Error occurring output 
11 U3E1-10000. bl0 | 10010 伺服 ON 状态 SRVON 
也 U3E1-10000.bl1 | 10011 伺服 OFF 状态 SRVOFF 
13 U3E1-10000. bl2 | 10012 循环 停止 状态 CYCLE 
14 U3E1-10000. bl3 | 10013 退 避 点 返回 状态 ”| SAFEPOS 
15 U3E1-10000. bl4 | 10014 电池 电压 过 低 状态 | BATERR 
16 U3E1-10001. bl 10016 H 级 报警 状态 HLVLERR 
17 U3E1-10001. b2 10017 L 级 报警 状态 LLVLERR 
18 U3E1-10001. b6 10022 程序 号 输出 状态 ”|PRGOUT 
19 U3E1-10001. b7 10023 程序 行 号 输出 状态 |LINEOUT 
20 U3E1-10001. b8 10024 倍率 输出 状态 OVRDOUT 
而 U3E1-10001. b9 10025 报警 号 输出 状态 | ERROUT 
22 U3E1-10002 10032 一 10047 数据 输出 地 址 


24.3.2 输入 输出 点 器 件 制作 方法 


以 自动 启动 按键 为 例 , 说 明 输 入 输出 点 制作 方法 。 
制作 “位 开关 型 "按键 一 一 “启动 ”按键 。 
(1) 在 GOT 界面 上 制作 按键 ,如 图 24-9 所 示 。 


机 老人 揉 作 屏 


图 24-9 GOT 界面 制作 


(2) 设置 “启动 ”按键 的 器 件 号 为 U3E0-10000. b6。 该 按键 U3E0-10000. b6, 如 
图 24-10 所 示 对 应 到 机 器 人 中 的 输入 信号 地 址 为 10006, 见 表 24-1。 
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设置 "启动 "按键 对 应 的 
器 件 号 =U3E0-10000.b6 
详 甸 设置 
扩展 功能 动作 条 件 9 


基本 设置 


24-10 “启动 ”按键 器 件 号 的 设置 


(3) 在 机 器 人 软件 RT ToolBox 中 设置 “启动 ”功能 对 应 的 输入 地 址 号 为 *10006”, 如 
图 24-11 所 示 。 


START 对 应 的 输入 
地 址 号 =10006 


图 24-11 “启动 ”功能 对 应 的 输入 地 址 号 为 “10006” 
经 过 以 上 编写 设置 ,触摸 屏 上 的 “启动 ”按键 就 对 应 了 机 器 人 的 “启动 ”功能 。 


24.4 程序 号 的 设置 与 显示 


程序 号 的 设置 与 显示 是 客户 最 基本 的 要 求 之 一 。 其 制作 方法 如 下 ,参见 图 24-12。 
24.4.1 程序 号 的 选择 设置 


(1) 在 GOT 上 制作 一 “数据 输入 ”器 件 ,该 器 件 用 于 输入 数据 。 器 件 的 地 址 号 根据 
表 24-1 设置 为 “U3E0-10002”, 如 图 24-13 所 示 。 

(2) 在 机 器 人 参数 中 ,IODATA 参数 用 于 设置 “数据 输入 ”的 一 组 “输入 信号 的 起 始 " 地 
址 。 将 与 GOT 器 件 U3E0-10002 对 应 的 输入 地 址 10032 一 10047 设置 到 参数 IODATA 中 ， 
如 图 24-14 所 示 。 


种 类 (Y): 避 数值 是 示 9 
软 元 件 (D): 。 |]u3E0-10002 四 | 数据 类 型 (A): [有 符号 BIN16 = 


设置 软 元 件 号 
=U3E0-10002 


[ ET ER 
程序 选择 ] PRssa 10020 
请 求 输出 已 速度 比率 选择 OWRDSEL 10021 
选择 的 程序 号 机 可 人 控制 本 电源 ON 结束 REREADY 
| 虹 池 电压 低下 输 击 信 号 BATERR 
序号 输出 要 求 [PRGOUT 10022 | 答 诛 号 输出 中 PRGOUT 
人 UNEOUT_ 10023 UNEOUT 
速度 比率 输出 值 要 求 OVRDOUT 10024 速度 比率 值 输出 中 OVRDOUT 
报 要 号 办 寺 要求 | RROUT 10025 [EEE En 
盘 内 温度 输出 要 求 | meou [要 内 温度 输出 中 TMPOUT 
| 而 开始 5) 结束 开始 四 结束 D) 
- 值 输入 | iooArA 10032 10047 JODATA 10032 10047 
设置 用 于 数据 输入 的 
痊 入 信号 地 址 
输入 信号 地 = 


设置 用 于 数据 输出 
的 输出 信号 地 址 


轴 
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(3) 在 机 器 人 一 侧 , 还 必须 定义 输入 数据 的 用 途 , 输 入 的 数据 是 作为 程序 号 还 是 速度 倍 
率 ,因此 还 有 一 个 数据 用 途 的 确认 键 。 参 数 “PRGSEL( 程 序 选择 )” 就 是 将 输入 的 数据 确认 
为 程序 号 。 


24.4.2 程序 号 输出 


当选 择 程序 号 完成 后 ,必须 在 GOT 上 进行 显示 ,以 确保 所 选择 程序 号 的 正确 性 。 

制作 方法 如 下 ,参见 图 24-15。 

(1) 在 GOT 上 制作 一 个 数据 输出 器 件 , 该 器 件 用 于 显示 输出 数据 。 器 件 的 地 址 号 根据 
表 24-2 设置 为 U3E1-10002 。 


设置 显示 输出 数据 
的 软 元 件 地 址 =U3E1-10002 


图 24-15 输出 器 件 号 的 设置 


(2) 在 机 器 人 参数 中 ,IODATA 参数 用 于 设置 数据 输出 的 一 组 输出 信号 的 起 始 地 址 。 
将 与 GOT 器 件 U3E2-10002 对 应 的 输入 地 址 10032 一 10047 设置 到 参数 IODATA 中 。 

对 机 器 人 一 侧 ,还 必须 定义 输出 数据 的 用 途 , 输 出 数据 是 作为 程序 号 还 是 速度 倍率 , 因 
此 还 有 请 求 输出 数据 的 确认 键 。 参 数 PRGOUT( 请 求 输出 程序 号 ?就 是 将 输出 数据 确认 为 
程序 号 。 


24.5 速度 倍率 的 设置 和 显示 


在 GOT 上 设置 和 修改 速度 倍率 也 是 客户 最 基本 的 要 求 。 在 GOT 上 设置 和 修改 速度 
倍率 的 方法 如 下 ,如 图 24-16 所 示 是 在 GOT 上 制作 的 速度 倍率 设置 界面 。 


24.5.1 速度 倍率 的 设置 


(1) 在 GOT 上 制作 一 个 数据 输入 器 件 ,该 器 件 用 于 输入 速度 倍率 。 器 件 的 地 址 号 根据 
表 24-1 设置 为 U3E0-10002。 

为 使 用 方便 ,使 用 一 键 输入 方法 , 即 在 GOT 上 制作 10 个 按键 。 每 个 按键 用 于 输入 不 
同 的 速度 倍率 值 。 图 24-17 是 “速度 倍率 二 60%” 的 按键 制作 。 

(2) 在 机 器 人 参数 中 ,IODATA 参数 是 用 于 设置 数据 输入 的 一 组 输入 信号 的 起 始 地 
址 。 将 与 GOT 器 件 U3E0-10002 对 应 的 输入 地 址 10032 一 10047 设置 到 参数 IODATA 中 ， 
如 图 24-18 所 示 。 

这 种 设置 方法 可 以 设置 任意 的 “速度 倍率 ”。 

(3) 在 机 器 人 一 侧 ,还 必须 定义 输入 数据 的 用 途 , 输 入 的 数据 是 作为 程序 号 还 是 速度 倍 


这 度 售 率 调节 


开关 功能 
软 元 件 (D): 


soa): 
模式 (M): 用 户 指定 SS 


设置 输入 器 件 软 
元 件 =U3E0-10002 


| 园 常 数 (C): 60 


设置 本 器 件 固定 
输入 值 =60 


图 24-17 “速度 倍率 一 60% ”的 按键 制作 
率 , 因 此 还 有 一 个 数据 用 途 的 确认 键 。 参 数 OVRDSEL( 速 度 倍率 选择 ) 就 是 将 输入 的 数据 
确认 为 速度 倍率 。 
24.5.2 速度 倍率 的 输出 
当选 择 速度 倍率 完成 后 ,必须 在 GOT 上 进行 显示 ,以 确保 所 选择 速度 倍率 的 正确 性 。 


制作 方法 如 下 。 
(1) 在 GOT 上 制作 一 个 数据 输出 器 件 , 该 器 件 用 于 显示 输出 数据 。 器 件 的 地 址 号 根据 

表 24-2 设置 为 U3E1-10002, 如 图 24-19 所 示 。 第 
(2) 在 机 器 人 参数 中 ,IODATA 用 于 设置 数据 输出 的 一 组 输出 信号 的 起 始 地 址 。 将 与 | 24 
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确认 输入 数据 |、 肥 5 
为 程序 号 
得 选择 


设置 用 于 数据 输入 的 
输入 信号 地 址 


” Ese) [5Xn 
设置 用 于 数据 输出 
的 输出 信号 地 址 


24-18 在 机 器 人 软件 一 侧 的 设置 


基本 设 轩 详细 设 轩 
[样式 "用 导 扩 展 功能 了 显示 /动作 条 件 了 运算 ] 


种 类 (Y): 加 数值 是 示 个 数值 输入 


软 元 件 (D): 。。 [U3E1-10002 - 四 数据 类 型 (A): | 有 符 88IN16 


设置 显示 输出 数据 
的 软 元 件 地 址 =U3E1-10002 


24-19 “数据 输出 ”器 件 的 设置 


GOT 器 件 U3E2-10002 对 应 的 输入 地 址 10032 一 10047 设置 到 参数 IODATA 中 。 

(3) 对 机 器 人 一 侧 ,还 必须 定义 输出 数据 的 用 途 , 输 出 数据 是 作为 程序 号 还 是 速度 倍 
率 ? 因此 还 有 请 求 输出 数据 的 确认 键 。 参 数 “OVRDOUT( 请 求 输出 “速度 倍率 ')” 就 是 将 
输出 数据 确认 为 速度 倍率 。 


24.6 机 器 人 工作 状态 读 出 及 显示 


如 第 6 章 所 示 ,. 有 大 量 表示 机 器 人 工作 状态 的 变量 。 这 些 数字 型 变量 也 可 以 经 过 处 
理 后 在 GOT 上 显示 ,图 24-20 就 是 各 轴 工 作 负 载 率 (工作 电流 ) 的 显示 。 其 制作 方法 
如 下 。 

从 表 24-2 可 知 , 可 以 使 用 的 输出 信号 范围 为 10000 一 18191 ,这些 输出 信号 对 应 在 GOT 
上 为 字 器 件 U3E1-10000 一 10511。 即 有 512 个 字 器 件 可 供 使 用 。 

只 要 在 机 器 人 程序 中 编制 某 一 状态 变量 与 输出 信号 的 关系 ,就 可 以 将 状态 变量 显示 在 
GOT 上 。 

显示 各 轴 工 作 负 载 率 (工作 电流 ) 的 制作 方法 如 下 。 


工作 状态 显示 屏 


» 运 行 轩 和 急 停 圈 
4 相国 6 所 


国 国 ， 


操作 权 


123456, 


图 24-20 各 轴 工 作 负载 率 显 示 屏 


(1) 在 GOT 上 使 用 U3E1-10016 一 10021 作为 卫 一 J6 轴 的 工作 电流 显示 部 件 , 如 表 24-3 
所 示 。 
表 24-3 输出 信号 对 应 表 
序 号 GOT 机 器 人 (out) 功 能 
1 U3E1-10016 10256~10271 用 轴 工 作 电 流 
2 U3E1-10017 10272 一 10287 J2 轴 工 作 电 流 
3 U3E1-10018 10288 一 10303 J3 轴 工 作 电 流 
4 U3E1-10019 10304 一 10319 J4 轴 工 作 电 流 
5 U3E1-10020 10320 一 10335 J5 轴 工 作 电流 
6 U3E1-10021 10336 一 10351 J6 轴 工 作 电 流 


(2) 在 机 器 人 程序 中 编制 一 个 子 程序 ,专门 用 于 显示 工作 电流 ,在 需要 时 调用 该 程序 。 
程序 号 60， 

M_OUTw(10256) =M_LdFact(1) ' 第 1 轴 工 作 电流 

M_OUTw(10272) = M_LdFact(2) ' 第 2 轴 工 作 电 流 

M_OUTw(10288) =M_LdFact(3) ' 第 3 轴 工 作 电 流 

M_OUTw(10304) = M_LdFact(4) ' 第 4 轴 工 作 电流 

M_OUTw(10320) =M_LdFact(5) ' 第 5 轴 工 作 电 流 

M_OUTw(10336) =M_LdFact(6) ' 第 6 轴 工 作 电 流 


运行 该 程序 后 就 在 GOT 上 显示 了 各 轴 的 工作 电流 。 
24.7 JOG 界面 制作 


JOG 是 机 器 人 的 一 种 工作 模式 ,在 没有 示 教 单元 的 场合 ,可 以 使 用 GOT 进行 JOG 
操作 。 

制作 JOG 界面 ,关键 在 于 机 器 人 一 侧 的 参数 设置 。 有 关 JOG 操作 的 输入 信号 地 址 是 
固定 的 ,不 可 随意 设置 ,如 果 随 意 设置 ,机 器 人 系统 会 报警 。 必 须 按 表 24-4 和 图 24-21 设置 
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分 配给 JOG 的 输入 输出 信号 。 
表 24-4 输入 信号 对 应 表 
en 机 器 人 规定 对 应 的 功能 信号 
(被 固定 分 配 ) 功能 参数 名 称 

1 U3E0-10005. bl12 10092 JOG 有 效 JOGENA 
二 U3E0-10006. b0 10096 及 十 

3 U3E0-10006. bl 10097 Jz+ 

4 U3E0-10006. b2 10098 J3 十 

5 U3E0-10006. b3 10099 J4 十 

6 U3E0-10006. b4 10100 J5 十 

7 U3E0-10006. b5 10101 J6 十 

8 U3E0-10006. b6 10102 了 十 

9 U3E0-10006. b7 10103 J8+ 

10 U3E0-10007. b0 10112 1— 

型 U3E0-10007. bl 10113 J2— 

12 U3E0-10007. b2 10114 J3 一 

13 U3E0-10007. b3 10115 J4 一 

14 U3E0-10007. b4 10116 J5 一 

15 U3E0-10007. b5 10117 J6 一 

16 U3E0-10007. b6 10117 J7— 

17 U3E0-10007. b7 10117 J8— 

18 U3E0-10005. b13 10093 JOG 直 交 模式 

19 U3E0-10005. bl14 10094 JOG 关节 模式 

20 U3E0-10005. bl15 10095 JOG Tool 模式 
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图 24-21 分 配给 JOG 的 输入 输出 信号 


由 于 在 机 器 人 一 侧 已 经 规定 了 输入 输出 信号 地 址 ,所 以 在 GOT 一 侧 的 器 件 号 也 就 被 
规定 了 。 
根据 表 24-4 制定 GOT 画面 中 的 各 按键 即 可 ,如 图 24-22 所 示 。 
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J06 操 作 屏 ”到 二] 


a 


[rz 


6) 
i ©® 


图 24-22 JOG 操作 屏 的 制作 与 设置 


24.8 需要 思考 的 问题 


与 机 器 人 连接 时 通信 参数 如 何 设置 ? 

中 的 软 元 件 如 何 与 机 器 人 中 的 输入 输出 信号 相对 应 ? 
盾 作 选择 程序 号 和 显示 程序 号 的 GOT 画面 ? 

央 作 设置 速度 倍率 和 显示 速度 倍率 的 GOT 画面 ? 
央 作 显示 机 器 人 工作 电流 的 GOT 画面? 


(6) 如 何 和 


央 作 显示 机 器 人 工作 状态 变量 的 GOT 画面 ? 
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【学 习 目 的 】 

在 工件 抛光 项 目 上 经 常 使 用 机 器 人 。 本 章 要 学 习 根 据 工 作 路 径 编 制程 序 的 方法 。 抛 光 
项 目 中 关键 的 技术 是 检测 工件 与 抛光 轮 之 间 的 压力 ,本 章 提 供 了 一 种 解决 方案 。 在 抛光 项 
目 中 ,还 有 许多 与 抛光 轮 速度 材质、 磨料 相关 的 工艺 参数 ,需要 在 实践 中 摸索 。 


25.1 项 目 综 述 


某 客 户 的 工件 要 求 采用 机 器 人 抓 取 实 现 抛 光 。 工 件 如 图 25-1 所 示 , 要 求 抛 光 5 个 面 。 


、 地 光 运 行 负 迹 由 机 器 人 完成 。 
(1) 抛光 轮 由 变频 电机 驱动 ,必须 能 够 预 
a 党 多 种 速度 。 
© |。 (2) 工件 由 机 器 人 夹 持 实施 抛光 ,抛光 面 
| 5 


/ (3) 机 器 人 由 两 套 系统 控制 一 一 外 部 硬 
件 操 作 屏 与 触摸 屏 GOT 构成 。 在 触摸 屏 上 
可 以 设置 各 种 工作 参数 ,例如 “位 置 补偿 值 ”。 


图 25-1 加 工 工件 


(4) 能 够 简单 检测 抛光 质量 。 

(5) 要 求 机 器 人 运行 轨迹 符合 工件 的 3D 轨迹 。 

(6) 能 够 进行 工件 计数 。 

(7) 夹 持 工 件 不 需要 视觉 装置 辅助 调整 。 

(8) 能 够 提供 实用 的 工艺 参数 (抛光 轮 速 度 ,机 器 人 运行 线 速度 ,抛光 轮 及 磨料 )。 
(9) 抛光 精度 二 0. 12mm。 

(10) 成 本 低 。 


25.2 解决 方案 


25.2.1 硬件 配置 


1. 硬件 配置 一 览 表 
经 过 技术 经 济 分 析 ,决定 采用 如 表 25-1 所 示 硬 件 配置 。 


表 25-1 硬件 配置 


序 号 名 称 型 号 数 量 备 注 
刘 机 器 人 RV-2F 和 三 
光 简易 示 教 单元 R33TB 证 三 
3 输入 输出 卡 2D-TZ368 1 三 
4 PLC FX3U-32MR 1 三 
5 触摸 屏 GS1000 1 三 
6 变频 器 A740-2. 2K 1 三 
电机 普通 电机 2kW 1 
8 光电 开关 1 
2. 硬件 配置 说 明 


硬件 选 配 以 三 菱 机 器 人 RV-2F 为 中 心 ,该 机 器 人 为 6 轴 机 器 人 ,由 于 需要 对 5 个 工作 
面 进行 抛光 作业 ,所 以 必须 选择 6 轴 机 器 人 ,同时 工件 加 抓 手 重量 小 于 2kg, 所 以 选用 搬运 
重量 为 2kg 的 机 器 人 。 

(1) 机 器 人 选用 RV-2F, 其 工作 参数 主要 指标 如 下 。 

Oa 夹 持 重量 : 2kg。 

@ 臂 长 : 504mm。 

@ 标 配 控制 器 : CR751D。 

(2) 示 教 单元 : R33TB( 必 须 选 配 ,用 于 示 教 位 置 点 ) 。 

(3) 机 器 人 选 件 : 输入 输出 信号 卡 2D-TZ368(32 输入 /32 输出 ), 用 于 接收 外 部 操作 屏 
信号 和 控制 外 围 设备 动作 。 

(4) 选用 变频 电机 十 三 鞭 变 频 器 A740-2. 2K 作为 抛光 轮 驱 动 系 统 。 速 度 可 调 。 

(5) 选用 三 菱 PLC FX3U-32MR 作为 主 控 系统 。 

(6) 触摸 屏 选 用 GS1000 系列 。 触 摸 屏 可 以 直接 与 机 器 人 相连 接 , 直 接 设置 和 修改 各 
工艺 参数 。 


25.2.2 应 对 客户 要 求 的 解决 方案 


1. 解决 方案 

(1) 抛光 轮 由 变频 器 十 普通 电机 驱动 ,由 PLC 控制 可 以 预 置 7 种 速度 ; 速度 值 可 以 
修改 。 

(2) 工件 由 机 器 人 夹 持 实施 抛光 。 机 器 人 搬运 重量 为 2kg,6 轴 , 辟 长 504mm。 可 实现 
复杂 的 空间 运行 轨迹 。 

(3) 触摸 屏 GS1000 可 以 直接 与 机 器 人 相连 接 , 直 接 设置 和 修改 各 工艺 参数 。 

(4) 使 用 机 器 人 的 负载 检测 控制 ,间接 实现 抛光 质量 检测 。 

(5) 在 进 料 输送 端 设置 挡 块 , 使 工件 定位 。 抓 手 为 内 张 型 抓 手 , 可 以 控制 定位 位 置 。 同 
时 放大 抛光 行程 ,可 以 满足 工件 表面 全 抛光 的 要 求 。 

(6) 工件 计数 由 秃 料 端 光 电 开 关 检 测 , 有 PLC 计数 ,在 GOT 上 显示 。 

(7) 机 器 人 重复 定位 精度 为 0.02mm, 可 以 满足 二 0. 12mm 的 要 求 。 

(8) 抛光 工艺 参数 必须 通过 工艺 实验 确定 。 以 下 是 工艺 实验 方案 。 
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2. 工艺 实验 方案 

1) 抛光 轮 材 料 ,磨料 、 速 度 与 抛光 工件 质量 的 关系 

在 机 器 人 运行 速度 确定 和 抛光 磨料 确定 的 条 件 下 测试 抛光 轮 材 料 、 速 度 与 工件 抛光 质 
量 的 关系 。 

实验 时 以 不 同 的 磨 轮 ( 不 同 材料 的 磨 轮 ) 在 不 同 的 转速 下 做 实验 。 实 验 记录 表格 如 
表 25-2 一 表 25-4 所 示 。 


表 25-2 磨 轮 速度 与 抛光 工件 质量 的 关系 1 
机 器 人 运行 速度 ( 秒 / 件 ) ” 抛光 磨料 : 甲 


速度 1 速度 2 速度 3 速度 4 速度 5 
抛光 轮 A 
抛光 轮 B 
抛光 轮 C 
抛光 轮 D 
抛光 轮 E 
表 25-3 ” 磨 轮 速度 与 抛光 工件 质量 的 关系 2 
机 器 人 运行 速度 ( 秒 / 件 ) ”抛光 磨料 : 乙 
速度 1 速度 2 速度 3 速度 4 速度 5 
抛光 轮 A 
抛光 轮 B 
抛光 轮 C 
抛光 轮 D 
抛光 轮 EE 
表 25-4 ” 磨 轮 速度 与 抛光 工件 质量 的 关系 3 
机 器 人 运行 速度 ( 秒 / 件 ) ” 抛光 磨料 : 再 
速度 1 速度 2 速度 3 速度 4 速度 5 
抛光 轮 A 
抛光 轮 B 
抛光 轮 C 
抛光 轮 D 
抛光 轮 下 


2) 工件 抛光 质量 与 工作 电流 的 关系 

必须 测定 最 佳 工作 电流 。 因 为 磨 轮 是 柔性 磨 轮 ,无 法 预先 确定 运行 轨迹 ,而 工作 电流 表 
示 了 工件 与 磨 轮 的 贴 合 程度 ( 磨 削 量 ) ,所 以 必须 在 基本 选 定 磨 轮转 速 和 工件 运行 速度 后 , 测 
定 最 佳 工作 电流 。 只 有 达到 最 佳 工作 电流 ,才能 被 认为 是 正常 抛光 完成 。 实 验 时 需要 逐步 
加 大 抛光 磨 削 量 以 观察 工作 电流 的 变化 ,要 注意 磨 削 量 在 图 纸 给 出 的 加 工 范围 内 。 

工件 抛光 质量 与 工作 电流 的 关系 如 表 25-5 所 示 。 


表 25-5 工件 抛光 质量 与 工作 电流 的 关系 
序 号 工作 电流 工件 抛光 质量 


中 | 四 | ole|m 


25.3 机 器 人 工作 程序 编制 及 要 求 


编制 程序 的 要 求 如 下 。 

(1) 必须 按 工件 的 3D 轮廓 编制 运行 轨迹 。 不 采用 描 点 法 。 

(2) 能 够 设置 1 次 .2 次 、3 次 磨 前 量 。 能 够 设置 磨 轮转 速 。 

(3) 能 够 根据 磨 轮 材料 自动 匹配 磨 轮转 速 、 工 件 线 速度 。 根 据 每 一 工件 的 最 少 加 工时 
间 ( 效 率 ) 确 定 工件 运动 线 速度 。 

(4) 自动 添加 抛光 磨料 。 

(5) 有 工件 计数 功能 。 


25.3.1 工作 流程 图 

如 图 25-2 所 示 为 抛光 工件 总 流程 图 。 主 要 核心 在 于 有 一 个 试 磨 程序 一 一 即 通 过 检测 
工作 负载 率 测试 工件 与 抛光 轮 的 贴 合 紧密 程度 ,如 果 达 到 最 佳 工作 电流 就 进入 正常 抛光 工 
作 程 序 , 如 果 未 达到 最 佳 工作 电流 就 进入 基准 工作 点 补偿 程序 ,所 以 最 佳 工作 电流 是 工件 抛 
光 质 量 的 间接 反映 。 


抓 料 子 程序 


1 


运行 到 基准 工作 点 
1 


试 麻子 程序 


Y 
fe 正常 折光 程序 


N 
基准 工作 点 补偿 御 料 子 程序 


图 25-2 工件 抛光 程序 总 流程 图 
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正常 抛光 工作 流程 如 图 25-3 所 示 ,包括 背面 抛光 和 其 余 4 个 面 的 圆 弧 抛光 。 


背面 抛光 子 程序 BP 


长 边 A 圆 弧 抛光 子 程序 LAARC 


1 
长 边 B 圆 弧 抛光 子 程序 LBARC 


短 边 A 圆 弧 抛 光子 程序 SAARC 


短 边 B 圆 弧 抛 光子 程序 SBARC 


1 
倒 角 子 程序 


1 


25-3 ”正常 抛光 工作 流程 


25.3.2 子 程序 汇总 表 


由 于 5 个 面 的 抛光 运行 轨迹 各 不 相同 ,为 简化 编程 ,预先 将 各 部 分 动作 划分 为 若干 子 程 
序 。 经 过 分 析 ,需要 编制 的 子 程序 如 表 25-6 所 示 。 


表 25-6 子 程序 汇总 


序 号 子 程序 名 称 功 能 程序 代号 
. 初始 化 程序 进行 初始 化 CSH 
2 抓 料 子 程序 抓 料 ZL 
3 试 磨 及 电流 判断 子 程序 | 试 磨 /电流 判断 /基准 点 补偿 ACTEST 
4 背面 抛光 子 程序 抛光 背面 BP 
5 长 边 A 抛光 子 程序 抛光 长 边 A 圆 弧 LAARC 
6 长 边 B 抛 光子 程序 抛光 长 边 B 圆 弧 LBARC 
短 边 A 抛光 子 程序 抛光 短 边 A 圆 弧 SAARC 
8 短 边 B 抛 光子 程序 抛光 短 边 B 圆 弧 SBARC 
9 圆 弧 抛 光子 程序 纯粹 圆 弧 抛光 YHPG 
10 圆 角 抛光 子 程序 1 抛光 圆 角 ARC1 
站 圆 角 抛光 子 程序 2 抛光 圆 角 ARC2 
2 圆 角 抛光 子 程序 3 抛光 圆 角 ARC3 
8 圆 角 抛光 子 程序 4 抛光 圆 角 ARC4 
14 印 料 子 程序 印 料 XIEL 


25. 


3.3 ”抛光 主 程序 
为 编程 简洁 明了 ,将 工作 程序 分 解 为 若干 子 程序 , 主 程序 则 负责 调用 这 些 子 程序 。 抛 光 


主 程序 MAIN100: 


25. 


25. 


1 CALLP "CSH"' 一 一 调用 初始 化 子 程序 。 

2 ”CALLP "ZL"' 一 一 调用 抓 料 子 程序 。 

3 ”CALLP "ACTEST" ' 一 一 调用 试 磨 电 流 判 断 子 程序 。 
4 ”x2C 一 一 正常 抛光 程序 运行 标记 。 

5 ”CALLP "BP" ' 一 一 调用 背面 磨 子 程序 。 
6 

时 

8 

9 


CALLP "LAARC" ' 一 一 调用 长 边 A 抛光 子 程序 。 
CALLP "LBARC" ' 一 一 调用 长 边 B 抛 光子 程序 。 
CALLP "SAARC" ' 一 一 调用 短 边 A 抛光 子 程序 。 
CALLP "SBARC" ' 一 一 调用 短 边 B 抛 光子 程序 。 
10 ”CALLP "ARC1" ' 一 一 调用 圆 弧 倒 角子 程序 1。 
11 ”CALLP "ARC2" ' 一 一 调用 圆 弧 倒 角子 程序 2。 
12 ”CALLP "ARC3" 一 一 调用 圆 弧 倒 角子 程序 3 
13 ”CALLP "ARC4" ' 一 一 调用 圆 弧 倒 角子 程序 4 
14 ”CALLP "XIEL"' 一 一 调用 卸 料 子 程序 。 
15 ”END' 一 一 主 程序 结束 。 


3.4 初始 化 子 程序 


初始 化 程序 用 于 对 机 器 人 系统 的 自 检 和 外 围 设 备 的 启动 和 检测 。 初 始 化 程序 如 下 。 
初始 化 程序 CSH: 


1 “' 初 始 化 程序 

2 * CSH' 一 一 初始 化 程序 标签 

3 M_0UT(10) =1' 一 一 抛光 轮 启 动 。 

4 DLY 0.5 ' 一 一 暂停 。 

5 M_0UT(11) =1 一 一 气泵 启动 。 

6 M10=M IN(10)' 一 一 M_IN(10) 气 压 检测 。 

7 M11=M_IN(11) ' 一 一 M_IN(11) 抛 光 轮 速度 到 位 检测 。 
8 M12=M IN(12)' 一 一 M_IN(12) 输 送 带 有 料 无 料 检测 。 
9 MI5=MI0+M11+MI2 

10 ' 一 一 判断 气压 ,抛光 轮 速度 ,有料 信 号 是 否 全 部 到 位 。 
11 IF M15 = 3 THEN' 一 一 判断 。 

12 GOTO * ZL' 一 一 跳 转 到 抓 料 子 程序 。 

13 ”ELSE' 一 一 否则 

14 GOTO * CSH' 一 一 跳 转 回 到 初始 化 子 程序 。 

15 ”endif' 一 一 选择 语句 结束 。 

16 END' 一 一 主 程序 结束 。 

17 #2 一 一 抓 料 子 程序 标签 。 

一 一 如 果 气 压 \ 抛 光 轮 速度 有料 信 号 全 部 到 位 ,就 进入 抓 料 程序 ,否则 继续 进行 初始 化 程序 。 


3.5 电流 判断 子 程序 第 
25 
* ACTEST' 电 流 检测 程序 章 
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M52 = M_LdFact(2) ' 一 一 检测 2 轴 负 载 率 。 
M53 = M_LdFact(3)' 一 一 检测 3 轴 负 载 率 。 
M55 = M_LdFact(5) ' 一 一 检测 5 轴 负 载 率 。 
M60 = M52 + M53 + M55 ' 一 一 M60 为 综合 负载 率 。 
P1 = P1 + P101 ' 一 一 ?101 为 磨 削 补 偿 量 。 
Mov P1 ' 一 一 ?1 试 磨 起 点 (基准 点 ) 。 
MVS P2 一 一 试 麻 终 点。 
If M60 <M_100 Then' 一 一 "工作 电流 判断 "(M_100 为 工艺 规定 数据 ,可 以 设 定 ) 。 如 果 综 合 负载 
率 小 于 工艺 规定 数据 , 则 
9 ”P101.X=P101.X+0.01' 一 一 P101 为 磨 削 补偿 (对 试 磨 基准 点 进行 补偿 ) 。 
10 ”GOTO x ACTEST' 一 一 重新 试 磨 。 


OI 


11 Else' 否则 
12 GOTO x PG100' 一 一 PG100 为 正常 抛光 程序 。 
13 EndIf' 一 一 选择 语句 结束 。 


14 END' 一 一 主 程序 结束 。 


25.3.6 背面 抛光 子 程序 


1. 背面 抛光 运行 轨迹 
背面 抛光 程序 必须 考虑 做 三 次 抛光 运行 。 每 一 次 比 前 一 次 有 一 个 微 前 进 量 。 背 面 抛光 
运行 轨迹 如 图 25-4 所 示 。 以 Pl 点 为 基准 点 ,其 p4 pl ps p7 
余 P2.P3、P4 各 点 根据 P1 点 计算 。 运 行 轨 迹 为 ”第 1 循环 ?9 
Pl-=P2-*P3—™”P4— Po-=P6-—>P3->P4-=P7-— 
P8 一 P3 。 
2. 背面 抛光 子 程序 BP 


第 2 循环 


1 1 

1 1 

人 

1 | 第 3 循环 

上 1 
1 P2=Pl-P_10' 一 一 P_10 为 工件 长 。 1 
2 P3=P2-P_11' 一 一 P_11 为 退 刀 量 。 |， 
3 P4=P3+P_10' 一 一 赋值 。 -0 
4 一 一 第 1 次 粗 抛 光 循环 。 了 到 P2 P6 PS 
5 MOV P1' 一 一 Pl 为 测定 的 基准 点 。 背面 抛光 运行 轨迹 
6 
7 
8 


人 图 25-4 ”背面 抽 光 运行 轨迹 
MVS P4' 一 一 移动 到 P4 点 。 
9 一 一 第 2 次 抛光 循环 
10 MVS Pl1+P101' 一 一 P101 为 1# 进 刀 量 。 
11 MVS P2 + P101' 一 一 移动 到 "P2 + P101"。 
12 MVS P3' 一 一 移动 到 "P3 点 "。 
13 MVS P4' 一 一 移动 到 "P4 点 "。 
14 一 一 第 3 次 抛光 循环 
15 MVS Pl1+P102' 一 一 P102 为 2# 进 刀 量 。 
16 MVS P2 + P102' 一 一 移动 到 "P2 + P102"。 
17 MVS P3' 一 一 移动 到 "P3 点 "。 
18 MVS P4' 一 一 移动 到 "P4 点 "。 
19 END' 一 一 主 程序 结束 。 


25.3.7 长 边 A 抛光 子 程 序 


1. 长 边 圆 跌 的 抛光 运行 轨迹 
长 边 圆 弧 的 抛光 运行 轨迹 分 为 上 半圆 弧 运行 轨迹 和 下 半圆 弧 运 行 轨 迹 , 如 图 25-5 所 


示 。 这 是 因为 抛光 轮 的 抛光 工作 线 是 一 直线 ,而 且 是 按 一 个 方向 旋转 (图 中 是 顺 时 针 方向 )， 
为 简化 编程 ,将 其 分 为 上 半圆 弧 运 行 轨迹 和 下 半圆 弧 运行 轨迹 。 


上 半圆 弧 抛光 工作 线 
AN 


顺 时 针 


抛光 工作 线 


F 半 圆 红 人 -7 
运行 轨迹 _A/ 


25-5 长 边 圆 弧 抛光 运行 轨迹 示意 图 
2. 上 半圆 弧 运 行程 序 YHARC 
1) 上 半圆 弧 运 行 轨迹 
上 半圆 弧 运 行 轨迹 如 图 25-6 所 示 。 
2) 上 半圆 弧 运行 程序 YHARC 
Ovrd 20' 一 一 设置 速度 倍率 。 


P10=P Curr"' 取 当 前 点 为 P10。 

1 P11=P_Curr-P_38' 一 一 P_38 是 圆 弧 插 补 终点 数据 。P11 为 圆 弧 插 补 终点 。 
2 P12=P_Curr-P_36' 一 一 P_36 是 圆 弧 插 补 半径 数据 。P12 为 圆心 。 

3 ”MVR3 P10, P11, P12' 一 一 圆 弧 插 补 ,抛光 运行 。 

4 ”MVR3 P11, P10, P12' 一 一 圆 弧 插 补 ,回程 。 

5 MVR3 P10, P11,P12' 一 一 圆 弧 插 补 ,抛光 运行 。 

6 ”MVR3 P11, P10,P12' 一 一 圆 弧 插 补 ,回程 。 

7 MVR3 P10, P11,P12' 一 一 圆 弧 插 补 ,抛光 运行 。 

8 ”MVR3 P11, P10,P12' 一 一 圆 弧 插 补 ,回程 。 

9 End' 一 一 主 程序 结束 。 


3. 下 半圆 绝 运 行程 序 
1) 下 半圆 弧 运 行 轨迹 
下 半圆 弧 运 行 轨迹 如 图 25-7 所 示 。 


P22 


El me 一 -~- pl 
> ) 运行 轨迹 
a P10 P20 入 下 半 圆 弧 


图 25-6 上 半圆 弧 运 行 轨迹 图 25-7 下 半圆 弧 运 行 轨迹 
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30 日 学 嵌 工 业 机 器 人 


2) 下 半圆 弧 运行 程序 
Ovrd 20' 一 一 设置 速度 倍率 。 


oOoWDr 


P20=P_Curr' 一 一 取 当 前 点 为 P20。 

P21=P_Curr +P 38' 一 一 P_38 是 圆 弧 插 补 终点 数据 。P11 为 圆 弧 插 补 终点 。 
P22 =P_Curr +P_37' 一 一 P_37 是 圆 弧 插 补 半径 数据 。P22 为 圆心 。 

MVR3 P20, P21, P22'— 
MVR3 P21, P20, P22'—— 
MVR3 P20, P21, P22 ' 一 一 圆 弧 插 补 ,抛光 运行 。 
MVR3 P21, P20, P22 一 一 圆 弧 插 补 ,回程 。 
MVR3 P20, P21, P22 ' 一 一 圆 弧 插 补 ,抛光 运行 。 
MVR3 P21, P20, P22° 圆 弧 插 补 ,回程 。 


10 End' 一 一 主 程序 结束 。 


25.3.8 圆 狼 倒 角 子 程序 1 


1 


圆 缴 抛光 的 运行 轨迹 


本 工件 有 4 个 圆 弧 , 圆 弧 抛 光 的 运行 轨迹 如 图 25-8 所 示 。 


入 三 抛光 工作 线 


工件 


图 25-8 圆 弧 抛光 的 运行 轨迹 


圆 弧 倒 角 子 程序 用 于 对 工件 的 4 个 圆 角 进行 抛光 。 由 于 机 器 人 的 控制 点 设置 在 工件 中 
心 ,所 以 可 以 直接 将 工件 运行 到 如 图 位 置 后 ,进行 圆 弧 插 补 。 


2. 


wouw wm P 


圆 弧 倒 角 子 程序 ARC1 

Ovrd 20' 一 一 设置 速度 倍率 。 

P10=P_Curr' 一 一 P10 为 当前 位 置 点 。 

P11=P_Curr+P 28' 一 一 P_28 是 圆 弧 终点 数据 。 
P12=P_Curr -P26' 一 一 P_26 是 圆 弧 半径 。P12 是 圆心 。 
Mvr3 P10, P11, P12 一 一 圆 弧 倒 角 ,抛光 

Mvr3 P11, P10, P12 一 一 圆 弧 倒 角 ,回程 

Mvr3 P10, P11, P12 一 一 圆 弧 倒 角 ,抛光 。 

Mvr3 P11, P10, P12 一 一 圆 弧 倒 角 , 回程 。 


9 Mvr3 P10,P11,P12' 一 一 圆 弧 倒 角 , 抛 光 。 
10 Mvr3 P11,P10,P12' 一 一 圆 弧 倒 角 , 回 程 。 
11 Mvr3 P10,P11,P12' 一 一 圆 弧 倒 角 , 抛光 。 
12 End' 一 一 主 程序 结束 。 


“ 圆 弧 倒 角子 程序 "与 “长 边 圆 弧 抛 光 程序 ?在 结构 上 是 相同 的 ,都 是 对 工件 运行 圆 弧 轨 
迹 ,只 是 各 自 的 圆 弧 起 点 终点、 圆 弧 半径 圆心 位 置 各 不 相同 ,需要 做 不 同 的 设置 。 


25.3.9 空间 过 渡 子 程序 
1. 概 说 


工件 为 矩形 ,由 于 工件 有 5 个 面 需 要 抛光 ,抛光 磨 前 工作 线 为 抛光 轮 直 径 水 平 线 ,其 位 
置 是 固定 的 。 在 机 器 人 坐标 系 中 ,其 X、Z 坐标 是 固定 的 ,Y 坐标 取 抛 光 轮 中 心 线 。 因 此 , 编 


程序 的 工作 是 使 工件 待 抛光 面 与 抛光 轮 磨 削 工 作 线 有 相对 
运动 。 

由 于 机 器 人 夹 持 工 件 ,为 编程 方便 ,设置 “机 器 人 控制 点 ” 
为 工件 矩形 背面 中 心 点 ( 计 和 人 了 抓 手 长 度 因素 ) 。 

基准 抛光 点 为 背面 磨 削 的 起 点 , 即 工件 底部 中 心 点 位 于 磨 
前 线 Z 向 10mm 处 。 该 点 用 全 局 变量 P_01 表示 , 即 在 各 全 部 
程序 中 有 效 。 

为 了 将 各 待 抛光 面 移动 到 抛光 轮 工作 线 , 需 要 进行 空间 移 
动 。 机 器 人 的 “ 形 位 ”会 改变 。 其 中 , 绕 X/Y/Z 轴 的 旋转 是 通 
过 两 个 点 的 乘法 进行 的 。 本 节 是 编制 空间 过 渡 点 程序 。 通 过 
该 程序 实现 了 各 子 程序 的 连接 。 图 25-9 是 工件 尺寸 示意 图 。 

2. 专用 工作 位 置 点 

为 编程 需要 ,必须 预 置 专用 工作 点 。 专 用 工作 位 置 点 如 
表 25-7 所 示 。 


表 25-7 专用 工作 位 置 点 


图 25-9 工件 尺寸 示意 图 


序 号 变量 名 称 变量 内 容 变量 类 型 
P01 抛光 基准 点 全 局 
2 P_02 和 一 一 工件 到 2 长度 全 局 
3 P08 DD 一 一 工件 1/2 宽度 全 局 
4 P_04 H 一 一 工件 1/2 厚度 全 局 
5 P_05 E 一 一 工件 数据 ( 斜 边 - 直 边 ) 全 局 
绕 Y 轴 旋转 90* 
P ,0,0,0,90， 
6 _06 (0,0,0,0,90,0) 全 局 
J6 轴 旋 转 90 
(0,0,0,0, 0,90) 
7 本 6 0,0,0,0, 0,90 全 局 


3. 抛光 主 程序 MAIN100 的 核心 部 分 


(CALLP "BP" 调 用 背面 抛光 子 程序 ) 
1 MOV P_01 一 一 回 到 基准 点 。 
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贡品 洪 


30 日 学 烧 工 业 夫 器 人 


2 MVS P_01 - (2L, 0,0,0,0,0) ' 一 一 X 方 向 退 2L(L=1/2 工件 长 度 ),D= 1/2 工件 宽度 ,E= 斜 边 减 长 
边 ( 取 E=20)。 

4 ”MOVP_CURRxP_06' 一 一 B 轴 旋转 90"( 成 水 平面 )。 

5 MOVP_CURR-(0,0,L+10,0,0,0)' 一 一 Zz 方向 下 行 L+ 10mm。 

6 MOVP_CURR+ (L+R,0,0,0,0,0)' 一 一 Xx 方向 前 进 L+R, 到 圆 弧 插 补 起 点 。 

a 

8 

9 


CALLP "SAARC" ' 一 一 做 圆 弧 插 补 (三 次 ) 抛 光 短 边 1。 
MOV P_CURR - (E, 0,0,0,0, 0) ' 一 一 X 方 向 退 E( 斜 边 - 长 边 ) ,准备 磨 长 边 1。 
MOV J_CURR + (0,0, 0, 0,0, 90) ' 一 一 2 轴 旋 转 90"。 
10 MOV P_CURR + (X1,0,0,0,0,0)' 一 一 Xx 方向 前 进 (L-D+E) +R, 到 圆 弧 插 补 起 点 (XL = L-D+E+ 
R) 


11 ”CALLP "LAARC" ' 一 一 做 圆 弧 插 补 (三 次 ) 磨 长 边 1。 

12 MOV P_CURR - (X1, 0,0, 0, 0, 0) 一 一 Xx 方向 退 (L-D+E) + R, 准 备 磨 短 边 2。 

13 MOV J_CURR + (0,0, 0,0, 0,90) ' 一 一 2 轴 旋 转 90"。 

14 MOV P_CURR + (X2,0,0,0,0,0)' 一 一 Xx 方向 前 进 (E+R), 到 圆 弧 插 补 起 点 (Xl1 = E+R)。 
15 CALLP "SAARC" 一 一 磨 短 边 2 做 圆 弧 插 补 (三 次 )。 

16 ”MOV P_CURR - (E,0,0,0,0,0)' 一 一 Xx 方向 退 (E), 准 备 磨 长 边 2。 

17 MOV J_CURR + (0,0, 0, 0,0,90) ' 一 一 2 轴 旋 转 90°。 

18 MOV P_CURR + (X1, 0, 0, 0, 0, 0) ' 一 一 X 方 向 前 进 (C-D+E) +R, 到 圆 弧 插 补 起 点 。 

19 ”CALLP "LAARC" ' 一 一 做 圆 弧 插 补 (三 次 ) 磨 长 边 2。 

20 ”END' 一 一 主 程序 结束 。 


4. 关于 运行 轨迹 的 问题 

(1) 设置 TOOL 坐标 系 时 ,要 尽量 减 小 对 Z 轴 的 设置 ,因为 Z 方 向 过 大 , 则 会 出 现 如 果 
需要 摆 角 90" 时 ,机 器 人 不 能 够 完成 的 情况 ,所 以 在 设计 抓 手 时 ,应 该 尽量 缩短 抓 手 的 长 度 。 

一 般 地 ,机 器 人 的 位 置 控制 点 设置 在 抓 手中 心 点 (出 三 设置 在 机 械 IF 法 兰 中 心 点 ) 。 为 
了 使 抓 手 绕 XYZ 轴 都 能 够 旋转 (而 且 能 够 旋转 较 大 的 角度 ) ,就 必须 设置 Z 坐标 尽量 小 。 

(2) 工件 需要 旋转 某 一 角度 时 ,使 用 点 与 点 的 乘法 指令 效果 较 好 。 使 用 点 与 点 的 加 法 
有 时 可 以 得 到 同样 的 效果 ,有 时 得 到 意 想不到 的 轨迹 。 

(3) 对 于 TOOL 坐标 系 ,可 以 绕 其 中 某 一 点 旋转 ,但 运动 轨迹 不 一 定 是 需要 的 轨迹 。 

(4) 如 果 确 定 是 直线 运动 ,就 必须 用 MVS 指令 。 用 MOV 指令 可 能 出 现 意 想不到 的 
轨迹 。 

(5) 要 获得 确切 的 轨迹 ,必须 使 用 圆 弧 搬 补 指令 和 直线 指令 。 

(6) 尽量 少 使 用 全 局 变量 ,以免 全 局 变量 的 改变 影响 所 有 程序 。 


25.4 结 束 语 


抛光 项 目 涉 及 的 工艺 因素 很 多 ,是 比较 复杂 的 应 用 类 型 。 

(1) 从 机 器 人 的 使 用 角度 来 考虑 ,主要 是 磨 削 工作 电流 的 影响 ,因此 在 不 同 的 磨 轮 材料 
和 速度 下 ,检测 获得 适当 的 工作 负载 电流 值 极其 重要 。 

(2) 机 器 人 的 工作 运行 轨迹 有 多 种 编程 方法 ,本文 介绍 的 只 是 其 中 一 种 方法 。 

(3) 注意 在 圆 弧 磨 削 时 的 上 半圆 弧 与 下 半圆 弧 的 区 别 。 


25.5 需要 思考 的 问题 


(1) 如 何 规划 抛光 主 程序 ? 抛光 主 程序 的 程序 结构 包含 哪些 内 容 ? 
(2) 如 何 编制 机 器 人 工作 电流 检测 程序 ? 

(3) 如 何 编制 基准 工作 点 补偿 程序 ? 

(4) 如 何 编制 圆 弧 抛 光子 程序 ? 

(5) 如 何 编制 空间 过 渡 子 程序 ? 
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第 26 章 第 26 日 一 一 机 器 人 与 视觉 系统 


【学 习 目 的 】 

机 器 人 与 视觉 系统 的 联合 使 用 是 扩展 机 器 人 应 用 范围 的 重要 手段 ,目前 已 经 得 到 广泛 
使 用 。 本 章 要 学 习 机 器 人 与 视觉 系统 联合 使 用 的 方法 ,重点 是 如 何 将 视觉 系统 获得 的 信息 
转换 为 机 器 人 系统 的 位 置 坐标 。 


26.1 概 述 


在 很 多 流水 线 上 ,工件 的 摆 放 位 置 是 任意 的 , 当 工 件 随 流水 线 运行 到 机 器 人 工作 范围 
时 ,要 求 机 器 人 能 够 识别 这 些 工件 的 位 置 进行 抓 取 。 而 实际 上 ,机 器 人 只 能 够 根据 机 器 人 的 
坐标 系 动作 ,所 以 必须 采用 视觉 系统 一 一 照相 机 通过 照相 一 一 所 获得 的 工件 位 置信 息 传送 
给 机 器 人 。 视 觉 系统 所 获得 的 工件 位 置信 息 称 为 像素 坐标 , 即 根据 视觉 系统 的 坐标 系 所 获 
得 的 坐标 值 。 将 视觉 坐标 系 与 机 器 人 坐标 系 建立 关系 的 工作 称 为 标定 。 经 过 标定 后 ,视觉 
系统 传 过 来 的 位 置信 息 可 以 为 机 器 人 所 用 。 

本 章 介绍 视觉 系统 在 机 器 人 上 的 应 用 。 


26.2 前 期 准备 及 通信 设置 


26.2.1 基本 设备 配置 及 连接 
1. 基本 配置 
为 了 进行 视觉 通信 ,最 基本 的 硬件 配置 如 表 26-1 所 示 。 
表 26-1 视觉 通信 基本 硬件 配置 
序 号 设 备 数量 说 明 


Hub 

以 太 网 线 ( 直 线 》 
王仁 
校准 用 工件 
校正 用 指示 针 


maaaniwlv|- 
CE 


续 表 


序 号 设 备 数 量 说 明 
9 计算 机 1 
10 RT ToolBox2 1 机 器 人 软件 
11 In-sight Explorer 1 视觉 传感器 软件 
2. 连接 
如 图 26-1 所 示 ,机 器 人 与 计算 机 、 机 器 人 与 视觉 传感器 都 通过 以 太 网 进行 连接 。 
相机 视觉 传感器 


CR751-D 机 器 人 
控制 器 本 体 


所 J 

- 
Insight Explorer(EasyBuilder) 
视觉 传感器 软件 


图 26-1 视觉 系统 与 机 器 人 连接 


26.2.2 通信 设置 


由 于 是 以 太 网 通信 ,设置 原则 是 各 通信 设备 的 IP 地 址 在 同一 网 段 内 , 即 前 三 位 数字 相 
同 ,第 4 位 数字 不 同 。 

设置 要 求 如 下 。 

(1) 机 器 人 IP 地 址 设置 为 192. 168. 0. 20。 

(2) 计算 机 IP 地 址 设置 为 192. 168. 0. 30 , 子 网 掩 码 设置 为 255. 255. 255。 

(3) 视觉 传感器 IP 地 址 设置 为 192. 168. 0. 10。 

1. 机 器 人 IP 地 址 设置 

机 器 人 IP 地 址 设置 如 图 26-2 所 示 。 

(1) 在 RT ToolBox2 建立 新 工作 区 ; 

(2) 通信 设置 选择 TCP/IP; 

(3) 单 击 “ 详 细 设 定 ” 按 钮 设置 IP 地 址 为 192. 168. 0. 20。 

单 击 OK 按钮 ,设置 完成 。 

2. 计算 机 IP 地 址 设置 

计算 机 IP 地 址 设置 如 图 26-3 所 示 。 

(1) 单 击 计算 机 “控制 面板 ”; 

(2) 单 击 “ 网 络 和 Internet 协议 ”; 

(3) 单 击 “ 属 性 ”; 

(4) 选择 TCP/IPv4; 
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选择 2 单 击 “ 详 细 设 定 ” 按 钮 ， 
Address= 


设置 IP 地 址 


连接 时 使 用 

塞 Intel m) centrine B) Wireless-¥ 1030 
CE ) 

此 连接 使 用 下 列 项 目 @) 

加 i 网 络 客户 江 


回 轧 Qos 数据 世 计划 程序 
回 加 Microsoft 网 络 的 文件 和 打印 机 共享 
议 版 本 6 (TCP/IPW6) 


协议 版 坟 


加 二 拉 引 层 折 扑 六 现 且 射 各 /0 
加 二 机 计 导 拓 拉 发现 响应 程序 


ss) Wi |] Rm) 


描述 
了 /IP 。 访 协议 是 点 b 议 ， 
TCPIP。 的 RSPatb 议 它 提供 在 不 同 


CW ]( mn ] 


图 26-3 计算 机 IP 地 址 设置 
(6) 单 击 “确定 ”按钮 ,设置 完成 。 
3. 视觉 传感器 IP 地 址 设置 
操作 方法 如 图 26-4 所 示 。 
(1) 打开 RT 软件 ,选择 “在 线 ”>“ 参 数 ”一 “参数 一 览 ”, 设 定 参 数 NVTRGTMG==1。 
(2) 单 击 “ 以 太 网 ”一 选择 “设备 及 端口 ”, 弹 出 “设备 一 览 ” 框 。 
(3) 在 “设备 一 览 ” 框 中 选择 “OPT19”, 弹 出 “设备 参数 设 定 ” 框 。 
(4) 在 “自动 设 定 ” 框 中 选择 “网 络 视觉 传感器 ”。 
(5) 在 “IP 地 址 ” 框 中 设置 “192. 168. 0. 10”。 


(6) 在 “分 配 (COMDEV)” 框 中 设置 “COM2” 作 为 通信 口 。 
(7) 单 击 OK 按钮 。 


选择 “网 络 视觉 
设备 一 交 (OX = a 和 四 
设备 急 式 pe 址 人 
OPTI12 1: 服务 器 ”192.168.0.3 
OPTI13 1: 服务 器 192.168.0.4 
OpTI4 1 服务 器 192.168.0.5 
程 OPT1S 1: 服务 器 192.168.0.6 (NETMODE(: 
OPT16 1: 服务 器 ”192.168.0.7 Wo 1 | 
a ， opTI7 1: 志 #8 192.168.0.8 有 Piettk0:。 (wemsTp(9) 192 .168 . 0 .10 
时 OPTI8 1: 服务 器。 192.168.0.9 
峡 本 | H 23 
由 昌 下 Eee 1: 服务 器 192.168.0.10 庙 DSP) (NETPORT(10) 
击 因 依 8 关 娄 am = 
9 aes- | WY 设置 IP 地 址 AH 
司 Ethemeti 定 
加 后 现 二 8 双 数 结束 博得 (KJ: (CTERME19) 1; CRHLF 
市 大 监视 
昌国 维护 
村 
由 国 varAwons 
向 国 训 从 
和 主 圳 TooL 


图 26-4 视觉 传感器 IP 地 址 设置 


26.3 工具 坐标 系 原点 的 设置 


26.3.1 操作 方法 


由 于 在 后 续 的 操作 中 ,推荐 机 器 人 使 用 TOOL 坐标 系 进行 定位 ,所 以 必须 求 出 新 的 
TOOL 坐标 系 原 点 。 以 下 是 求 TOOL 坐标 系 原点 的 方法 。 

1. 安置 指示 针 

在 工作 台 上 安置 一 个 "工件 指针 ”, 作 为 以 下 机 器 人 抓 手 校准 的 标志 ,如 图 26-5 所 示 。 


ae) 


校准 用 的 针 2 | 


图 26-5 设置 TOOL 坐标 系 原 点 


2. 校准 方法 
(1) 对 齐 一 一 使 用 示 教 单元 JOG 动作 ,使 机 器 人 抓 手 “ 指 示 针 尖端 "对 齐 工作 台 上 的 | 第 
“指示 针 ”。 26 
章 
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束 。 


(2) 用 示 教 单元 打开 程序 TLXY( 见 26. 3.2 节 ) , 按 * 单 步 前 进 ? 到 第 5 行 MVS P91' 结 
这 时 , 抓 手 旋转 90°。 

(3) 再 次 使 用 示 教 单元 JOG 动作 ,使 机 器 人 抓 手 “指示 针尖 端 " 对 齐 桌 上 指示 针 。 

(4) 用 示 教 单元 打开 程序 TLXY( 见 26. 3. 2 节 ), 按 “ 单 步 前 进 ” 从 第 7 行 执行 到 END。 
(5) 用 示 教 单元 JOG 动作 ,在 “TOOL JOG” 模 式 下 , 按 C 十 ,C 一 ,机 器 人 动作 , 当 抓 手 


指示 针 与 桌面 指示 针 的 相对 位 置 不 变 时 ,新 的 “工具 坐标 系 原点 ”设置 完成 。 


26. 


(6) 在 RT ToolBox2 软件 中 打开 程序 TLXY 和 SVS。 
(7) 复制 程序 TLXY 中 的 位 置 变量 PLT2 ,粘贴 到 程序 SVS 中 ,保存 并 关闭 程序 。 


3.2 求 TOOL 坐标 系 原点 的 程序 TLXY 
程序 TLXY : 


'X— YTOOL setting program 

PTOOL = P_TOOL' P_Tool 为 当前 设置 的 TooL 坐标 系数 据 。 

P0 = P_FBC' 一 一 P_FBC 为 编码 器 反映 的 当前 位 置 。 

P91 = P0 * (0, 0,0, 0,0,90) 一 一 计算 P91 位 置 点 。 

MVS P91' 移动 到 P91 一 一 绕 Zz 轴 旋 转 90” 

1 ' 以 上 为 第 一 阶段 

P90 = P_FBC' 一 一 P_FBC 为 编码 器 反映 的 当前 位 置 。 

PTL =P_ZERO' 一 一 清 零 。 

PT = INV(P90) * P0' 一 一 BT 为 P90 与 P0 两 点 之 间 的 偏差 值 。 重 要 ! 
BTL.X= (PT.X+ PT.Y)/2' 一 一 PTL 为 偏差 值 的 中 间 量 。 

PTL.Y= ( -PT.X+PT.Y)/2 

PLT2 = PTOOL x PTL' 一 一 PLT2 为 在 原 TOOL 坐标 系 原点 加 上 偏差 量 后 的 位 置 点 。 
TOOL PLT2' 以 PLT2 为 当前 TOOL 坐标 系 原点 。 

HT' 一 一 暂停 


2 
3 
4 
5 


26.4 坐标 系 标 定 


坐标 系 标定 就 是 建立 视觉 传感器 坐标 系 与 机 器 人 坐标 系 之 间 的 关系 。 当 视觉 传感器 将 


像素 坐标 传 到 机 器 人 时 ,机 器 人 能 够 判定 像素 坐标 在 机 器 人 坐标 系 中 的 位 置 。 简 单 地 说 就 
是 建立 两 个 坐标 系 之 间 的 关系 ,就 相当 于 建立 工件 坐标 系 与 基本 坐标 系 之 间 的 关系 。 
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4.1 前 期 准备 


(1) 准备 带 标记 的 工件 . 带 标 记 的 工件 必须 与 实际 工件 高 度 相同 。 
(2) 标记 工件 必须 准备 5 个 。 


4.2 坐标 系 标定 步骤 

1，Insight Explorer 软件 的 初步 设置 

(1) 打开 软件 Insight Explorer。 

(2) 单 击 菜单 “系统 ”>“ 将 传感器 /设备 添加 到 网 络 ”。 

(3) 单 击 弹 出 的 “视觉 传感器 ”, 设 定 “ 视 觉 传 感 器 ”的 IP 地 址 为 192. 168. 0.10,“ 子 网 掩 


码 ” 为 255. 255. 255. 0。 

(4) 单 击 菜单 “系统 ”>“ 选 项 ”。 

(5) 单 击 “用 户 界面 ", 选 择 * 对 Easy Builder 使 用 英文 符号 标记 ”。 

(6) 单 击 “确定 ?按钮 。 

2. 视觉 传感器 的 观察 与 调节 

(1) 选中 视觉 传感器 , 单 击 “连接 ”。 

(2) 单 击 “联机 ”, 使 作业 JOB 进入 联机 状态 。 

(3) 单 击 工具 栏 中 的 “触发 "按钮 ,调整 镜头 的 亮度 和 焦点 ,一 直 调 整 并 触发 ,直到 工件 
清晰 地 出 现在 页 面 内 。 

(4) 选中 应 用 程序 步骤 中 的 “检查 部 件 ”。 

(5) 打开 “几何 工具 ”, 单 击 “ 用 户 定义 的 点 ”, 单 击 “ 添 加 ”, 一 共 需 要 添加 5 个 点 。 

(6) 移动 各 工件 (用 户 定 义 点 ) ,使 其 均匀 分 布 在 视觉 范围 内 。 

(7) 在 选择 板 中 可 以 看 到 这 5 个 点 的 “像素 坐标 ”( 这 是 最 重要 的 工作 目的 ) 。 

3. 视觉 传感器 的 精确 调节 

(1) 移动 工件 , 单 击 工具 栏 上 的 "触发 "按钮 ,不断 移 动 .触发 ,使 十 字 线 交叉 点 与 工件 标 
记 点 重合 (获得 像素 坐标 ) 。 

(2) 使 用 示 教 单元 移动 机 器 人 JOG ,使 抓 手指 示 针 与 工件 标记 十 字 线 重合 (停止 ,获得 
机 器 人 坐标 ) 。 

4. 坐标 系 标定 

(1) 打开 RT 软件 , 单 击 “ 维 护 ”>2D VISION Calibration ,选择 Calibration1( 可 以 选择 
Calibration1 一 Calibration8 中 的 任何 一 个 ) ,如 图 26-6 所 示 。 


四 Save 四 Save as… 


Calibration2 | Calibration3 | Calibration4 | Calibration5 | Calibration6 | Calibration7 | Calibration8 


Teaching points: 


等 Gettherobotpostion |14 4 11 /120 |， 时 


| 图 Calculate afterselecting 4 points ormore. 


26-6 ”RT 软件 设置 选择 标定 序号 


(2) 选中 做 好 标记 的 点 (以 第 3 点 为 例 ) , 单 击 Get the robot position 获得 当前 位 置 X、 
Y 坐标 值 ,如 图 26-7 所 示 。 
(3) 手动 输入 第 3 点 像素 坐标 。 
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(4) 按照 以 上 方法 获得 5 个 点 的 机 器 人 坐标 和 像素 坐标 ,在 标定 完成 前 ,必须 一 直 保 持 
伺服 = 二 ON。 

(5) 单 击 Calculation after selection 4 points or more, 计 算 两 个 坐标 系 之 间 的 关系 。 

(6) 单 击 Write to robot 按钮 写 和 机器人。 

(7) 单 击 Save 按钮 保存 。 


Teaching Points: 
回 
得 机 器 人 示 回 
教 点 坐标 值 百 0.000 上 | 0.000 汪 | 
回 0.000 凡 | 0.000|| 
回 0.000| 针 | 0.000 几 | 


将 计算 结果 
写 入 机 器 人 


Calculate afterselecting 4 points ormore. 


单 击 此 处 计算 
两 个 坐标 系 
之 间 的 关系 


Result homography matroc: (VsCALB1) 
( MIl M12 MI3 MI4 】 0.0000[ 0.0000] 0.0000] 加 ] FZ Wte to robot 


M21 M22 M23 M24 0.0000| 0.0000| 0.0000| 0.0000| 
M31 M32 M33 M34 0.0000| 0.0000| 0.0000| 0.0000| 


Curent homography matrix: 
MIl HI MI3 MI4 0.0000| ”0.0000| 0. 0.0000| 
H21 Ma2 M23 HM24 |= 区 0.0000| 0. 0.0000| 
M31 M32 M33 M34 Es 0.0000| 0. 0.0000| 


26-7 标定 方法 


经 过 以 上 步骤 后 ,标定 结束 。 


26.5 视觉 传感器 程序 制作 


定位 部 件 Pat Max 用 于 记忆 工件 的 特征 ,包括 工件 外 部 的 轮廓 和 工件 上 的 表面 特征 ， 
工件 周边 的 颜色 即 背景 色 。 所 以 在 调整 MODEL 框 时 ,应 该 尽 可 能 地 接近 工件 的 外 形 , 注 
意 周边 颜色 不 能 与 工件 颜色 相同 ,最 好 颜色 反差 较 大 。 

制作 视觉 传感器 程序 的 操作 方法 如 下 。 

在 Insight Explorer 软件 一 侧 的 设置 如 下 。 

(1) 打开 软件 Insight Explorer。 

(2) 新 建 作 业 。 

(3) 单 击 “触发 ”, 更 新 画面 。 

(4) 单 击 “设置 图 像 ”触发 器 " ,选择 “手动 ,调整 曝光 使 图 像 清晰 。 

(5) 单 击 “ 定 位 部 件 ”, 选 择 “ 位 置 工具 ”中 的 Pat Max 图 案 , 单 击 * 添 加? 按钮。 

视 区 内 会 出 现 两 个 矩形 ,分 别 是 “模型 "和 “搜索 ”。 

(6) 调整 “模型 ?矩形 ,使 其 包括 工件 。 

(7) 调整 “搜索 ”矩形 ,使 其 在 视觉 传感器 的 搜索 区 域内 。 单 击 OK 按钮 。 

(8) 保存 本 程序 ,程序 名 为 “TSC. ”。 


26.6 视觉 传感器 与 机 器 人 的 通信 


在 Insight Explorer 软件 一 侧 的 设置 如 下 。 

(1) 打开 软件 Insight Explorer。 

(2) 单 击 * 通 信 ” 一 添加 设备 ”。 

(3) 在 “设备 选择 ” 框 中 选择 “机 器 人 ”。 

(4) 在 “制造 商 ” 栏 中 选择 MITSUBISHI。 

(5) 在 协议 栏 中 选择 “以 太 网 本 机 字符 串 ”, 单 击 “ 以 太 网 本 机 字符 串 ”, 单 击 “ 添 加 ” 
按钮 。 

(6) 单 击 “Pattern_1”。 

(7) 选择 Fixture. X、Fixture. Y、Fixture. Angle、Pass_Count, 单 击 “ 确 定 ” 按 钮 。 

(8) 通过 “上 ”下 ”按钮 调整 顺序 。 调 整 结果 与 后 面 的 EBRead 指令 中 的 变量 顺序 
有 关 。 

(9) 设 定 完成 后 , 单 击 “ 保 存 ” 按 钮 。 


26.7 调试 程序 


1. 打开 软件 Insight Explorer 

单 击 “ 联 机 ”按钮 ,使 视觉 传感器 JOB 在 线 ( 注 意 如 果 视 觉 传感器 不 在 线 ,执行 程序 会 发 
生 报警 ,报警 代码 8650) 。 

2. 使 用 示 教 单元 确定 工作 点 

(1) 使 用 示 教 单元 打开 程序 SVS, 使 机 器 人 以 JOG 模式 动作 。 示 教 机 器 人 待机 位 置 
Phom 和 工件 抓 取 点 Pwk( 此 点 位 于 工件 上 ,不 同 于 标记 点 )。 示 教 完 成 后 不 可 以 移动 工件 。 

(2) 使 用 示 教 单元 关闭 程序 SVS, 保 存 程 序 。 

3. RT ToolBox2 软件 的 使 用 

(1) 打开 程序 SVS, 取 消 19 行 的 注释 符号 ,让 19 行程 序 生 效 。 

(2) 将 程序 中 17 行 .23 行 .57 行 的 内 容 改 为 "TSC. JOB”。 关 闭 并 保存 程序 。 

(3) 在 自动 模式 下 ,使 用 示 教 单元 选择 程序 SVS, 启 动 执 行 SVS, 程 序 运 行 结束 后 ,就 获 
得 抓 取 点 与 识别 点 之 间 的 补偿 量 PH。 


4. 调试 程序 

调试 程序 SVS: 

1 loadset 1.1' 一 一 选择 抓 手 及 工件 。 

2 ”OADL ON' 一 一 对 应 抓 手 及 工件 条 件 ,选择 最 佳 加 减速 模式 的 指令 。 

3 ”SERVO ON ,一 一 伺服 ON。 

4 WaITM SVO=1' 一 -MsSvo=1, 伺 服 电源 = ON。 

5 ”OVRD M_NOVRD ' 一 一 速度 倍率 的 初始 值 (100% ) 。 

6 ”SPD M_NSPD' 一 一 初始 速度 (最 佳 速度 控制 ) 。 第 
7 ”ACCEL 100, 100 一 一 加 减速 度 倍率 指令 (# ), 设 置 加 减速 度 的 百分数 。 26 
8 BRSE P_NBASE' 一 一 以 基本 坐标 系 的 初始 位 置 为 "当前 世界 坐标 系 "。 章 
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“注释 行 ”一 


9 TOOL PLT2' 一 一 以 PLT2 为 TOOL 坐标 系 原点 。 
10 “一 open port 

' 以 下 判断 1# 文 件 是 否 开启 ,如 果 没 有 开启 则 指令 com2 开启 ,并 一 直 等 待 1 井 文件 开启 完成 。 
11 IF m_nvopen(1)<> 1 then 
12 nvopen "com2:"as #1 

13 wait m nvopen(1) =1 


14 endif 


15 NVLoad #1,"tsc. job" ' 一 一 加 载 tsc. job 作为 1# 文 件 。 
19 GOSUB x* MAKE_PH' 一 一 调用 子 程序 * MAKE_PH。 
20 * MAIN' 一 一 程序 分 支 标志 


21 MOV PHOME' 
22 DLY 0.5" 


前 进 到 PHOME 点 。 
暂停 0.5 秒 。 


23 ”NVRUN #1,"tsc. job"' 一 一 运行 tsc. job 文件 并 将 tsc. job 作为 #1 文件 。 
24 EBREAD #1,"""",M1,PVS1' 一 一 读 1# 文 件 。 
25 IF M1 = 0 THEN ERROR 9102' 一 一 如 果 M1 = 0 则 报警 9102。 
26 DLY 0.5' 一 一 暂停 0.5 秒 。 
27 ”NVRUN #1"tsc. job" ' 一 一 运行 tsc. job 文件 并 将 tsc. job 作为 #1 文件 。 
29 EBREAD #1,"""",M1,PVS0' 一 一 读 1# 文 件 。 


5. 程序 的 保存 
(1) 自动 运行 完成 后 ,首先 关闭 在 计算 机 上 的 程序 。 此 时 ,不 要 保存 程序 ,因为 此 时 操 
作 错 误 的 话 ,刚刚 做 的 PH 数据 就 会 丢失 。 
(2) 在 RT ToolBox2 的 “在 线 ” 中 打开 程序 SVS, 将 19 行 “GOSUB * MAKE_PH” 变 为 


“ ”GOSUB * MAKE_PH”, 关 闭 并 保存 程序 。 


26.8 动作 确认 


(1) 在 自动 模式 下 ,使 用 示 教 单元 执行 SVS 程序 ,机 器 人 会 先 移动 到 PWK 位 置 ,然后 
再 回 到 Phome 位 置 。 
(2) 移动 工件 位 置 , 再 次 运行 SVS 程序 ,确认 机 器 人 会 先 移动 到 PWK 位 置 ,然后 再 回 
到 Phome 位 置 。 


26.9 与 视觉 功能 相关 的 指令 


常用 的 与 视觉 应 用 相关 的 指令 /状态 变量 如 表 26-2 所 示 。 
表 26-2 视觉 功能 相关 的 指令 一 览 表 


序号 指令 名 称 功 能 
1 |NVLoad 加 载 视觉 程序 将 指定 的 视觉 程序 加 载 到 视觉 传感器 
2 |NVOpen 连接 视觉 传感器 连接 指定 的 视觉 传感器 并 登录 注册 该 传感器 
3 |NVClose 关 断 视觉 传感器 通信 线路 ”| 关 断 视觉 传感器 通信 线路 
4 |NVI 接收 视觉 传感器 的 识别 信息 | 接收 视觉 传感器 的 识别 信息 
5 |NVPst 启动 视觉 程序 并 获取 数据 ”| 启动 指定 的 视觉 程序 并 获取 数据 
6 |NVRun 启动 运行 视觉 程序 启动 运行 指定 的 视觉 程序 


续 表 


序号 指令 名 称 功 能 
7 |NVTrg 指令 视觉 传感器 拍摄 图 像 指令 视觉 传感器 拍摄 图 像 
8 |PVSCL 视觉 标定 指令 
以 下 是 状态 变量 
以 位 置 数据 格式 保存 视觉 传 
9 |P_NvS1~P_NYS8 | 感 器 的 识别 信息 人 
10 |M_NvOpen 通信 连接 状态 变量 表示 视觉 通信 是 否 连接 完成 
11 |M_NvNum 检测 到 工件 总 数 的 状态 变量 | 表示 检测 到 工件 总 数 
12 |M_NvS1~M_NvS8 | 以 数值 表示 识别 信息 的 变量 | 数值 


NV: Network vision sensor, 网 络 视觉 传感器 。 


26.10.1 


1, 


26. 10 ”视觉 功能 指令 详细 说 明 


功能 


NVOpen 连接 视觉 传感器 


连接 视觉 传感器 并 登记 注册 该 视觉 传感器 。 


2. 


格式 


NVOpen "< 通信 口 编号 >”AS #< 视 觉 传感器 编号 > 


3。 


术语 


1) < 通信 口 编号 >( 不 能 省 略 ) 

以 与 OPEN 指令 同样 的 方法 设置 通信 口 编号 COM *x ,但 不 能 使 用 COM1。COMI 口 
是 TB 单元 的 RS-232 通信 专用 口 。 设 置 范围 COM2 一 COM8 。 

2) < 视觉 传感器 编号 >( 不 能 省 略 ) 

设置 与 机 器 人 通信 口 连接 的 视觉 传感器 编号 。 设 置 范 围 为 1 一 8。 


4. 


人 wb 


5. 


样 例 程序 


If M NvOpen(1)<>1 Then 


一 一 判断 1# 视 觉 传感器 是 否 连接 。 


NVOpen "COM2:" RS #1 ' 一 一 将 视觉 传感器 连接 到 COM2 口 并 设置 为 1# 传感器 。 


EndIf 


Wait M_NvOpen(1) =1 ' 一 一 等 待 1# 视 觉 传 感 器 连接 完成 。 


说 明 


(1) 本 指令 功能 为 连接 视觉 传感器 到 指定 的 通信 口 COM x 并 登记 注册 该 视觉 传感器 。 

(2) 最 多 可 连接 7 个 视觉 传感器 。 视 觉 传感器 的 编号 要 按 顺序 设置 ,用 逗号 分 隔 。 

(3) 与 OPEN 指令 共同 使 用 时 ,OPEN 指令 使 用 的 通信 口号 COM ** 和 “文件 号 ”与 本 
指令 使 用 的 通信 口号 COM xx 和 “视觉 传感器 编号 ”要 合理 分 配 ,不 能 重复 。 例 如 : 


1 Open "COM1:" RS #1 


2 NVOpen "COM2:" AS #2 
3 NVOpen "COM3:" AS #3 


第 26 日 一 一 机 器 人 与 视觉 系统 


30 日 学 烧 工 业 机 器 人 


如 下 为 错误 的 样 例 : 


1 Open "COM2:" AS #1 

2 ”NVOpen "COM2:" RS #2 ' 一 一 COM2 口 已 经 被 占用 。 

3 ”NVOpen "COM3:" RS #1' 一 一 "视觉 传感器 编号 "已 经 被 占用 。 

在 一 台 机 器 人 控制 器 和 一 台 视 觉 传 感 器 的 场合 ,开启 的 通信 线路 不 能 够 大 于 1。 

(4) 注册 视觉 传感器 需要 “用 户 名 ”和 “密码 ”, 因 此 需要 在 机 器 人 参数 NVUSER 和 
NVPSWD 中 设置 “用 户 名 ”和 “密码 ”。 用 户 名 和 和 密码 可 以 为 15 个 字符 ,是 数字 0 一 9 及 A 一 
Z 的 集合 。T/B( 示 教 器 ) 仅 支持 大 写字 母 ,所 以 使 用 T/B 时 设置 用 户 名 和 密码 必须 使 用 大 
写字 母 。 购 置 的 网 络 视 觉 传感器 的 用 户 名 是 “admin”。 密 码 是 *”。 因 此 参数 NVUSER 和 
NVPSWD 的 预 设 值 为 : 


[NVUSER] = "admin" and [NVPSWD] = "" 


当 使 用 MELFA-Vision 更 改 用 户 名 和 密码 时 ,必须 更 改 参数 NVUSER 和 NVPSWD。 
更 改 参数 后 断 电 上 电 后 参数 生效 。 

注意 : 如 果 连 接 多 个 视觉 传感器 到 一 个 机 器 人 控制 器 , 则 所 有 视觉 传感器 必须 使 用 同 
样 的 用 户 名 和 密码 。 

(5) 本 指令 的 执行 状态 可 以 用 M_NvOpen 状态 变量 检查 。 

(6) 如 果 在 执行 本 指令 时 ,程序 被 删除 , 则 立即 停止 。 再 启动 时 , 按 顺 序 联机 传感器 。 
必须 复位 机 器 人 程序 再 启动 。 

(7) 在 多 任务 工作 时 使 用 本 指令 ,有 如 下 限制 : 不 同 的 任务 区 的 程序 中 “通信 口 编号 
COM xx “视觉 传感器 编号 "不 能 相同 。 

@ 如 果 使 用 了 相同 的 COM xx 编号 , 则 会 出 现 “attempt was made to open an already 
open communication file( 试 图 打开 已 经 被 开启 了 的 一 个 通信 口 )” 报 警 。 

如 图 26-8 所 示 ,在 任务 区 2 和 任务 区 3 中 都 同时 指定 了 COM2 口 ,所 以 报警 。 


[stor 2) 
10 NVOPEN “COMZ2” AS sl 


图 26-8 在 任务 区 2 和 任务 区 3 中 都 同时 指定 了 COM2 口 


@ 如 果 设 置 了 同样 的 “视觉 传感器 编号 ”也 会 报警 。 
图 26-9 中 ,在 任务 区 2 和 任务 区 3 中 都 指定 了 1# 视 觉 传感器 ,所 以 报警 。 


(stor 3) 
10 NVOPEN “COM2” AS #2 


[stoT2) {sor3) 
10NVOPEN "COMZ” AS #1 IONVOPEN "COM As 
a | 


图 26-9 在 任务 区 2 和 任务 区 3 中 都 指定 了 1 井 视觉 传感器 


(8) 不 支持 启动 条 件 为 Always 与 设置 为 “连续 功能 ”的 程序 。 

(9) 在 构建 系统 时 要 注意 .一 个 视觉 传感器 可 以 同时 连接 三 个 机 器 人 ,如 果 连 接 第 4 个 
机 器 人 , 则 第 1 个 被 切断 。 

(10) 调用 子 程序 时 ,通信 连接 不 会 被 切断 ,但 是 主 程序 的 END 指令 与 复位 指令 会 切断 
通信 连接 。 

如 果 在 执行 本 指令 时 , 某 个 中 断 程序 的 启动 条 件 成 立 , 则 立即 执行 中 断 程 序 。 

6. 报警 

(1) 如 果 数 据 类 型 是 错误 的 , 则 会 出 现 “syntax error in input command( 指 令 语法 错 
误 )” 报 警 。 

(2) 如 果 COM ** 口 编号 不 是 COM2 一 COM8 ,会 报警 。 

(3) 如 果 视 觉 传 感 器 编号 不 是 1 一 8 ,会 报警 。 


26. 10.2”NVClose 一 一 关 断 视觉 传感器 通信 线路 指令 


1. 功能 
关 断 视觉 传感器 通信 线路 。 
2. 格式 


NVClose[ [ # ]< 视 觉 传 感 器 编号 >[，[[ # ]< 视 觉 传 感 器 编号 > … ] 


3. 术语 

视觉 传感器 编号 (不 能 省 略 ): 指 连 接 到 机 器 人 通信 口 的 视觉 传感器 编号 (可 能 在 一 
网 络 上 有 多 个 视觉 传感器 ) 。 设 置 范围 为 1 一 8。 如 果 有 多 个 传感器 ,用 逗号 分 隔 。 

4. 样 例 程序 

1 If M_NvOpen(1)<>1 Then ' 一 一 判断 1# 视 觉 传感器 是 否 联 机 完成 。 

2 NVOpen "COM2:" AS #1 ' 一 一 在 COM2 口 连接 视觉 传感器 并 将 其 设置 为 1# 传 感 器 。 

3 EndIf 

4 Wait M_NvOpen(1) =1' 一 一 等 待 1# 传 感 器 联机 通信 完成 。 
5 
型 


0 NVClose #1' 一 一 关 断 1# 视 觉 传感器 与 COM2 口 的 通信 。 


5. 说 明 

(1) 本 指令 功能 为 关 断 在 NVOpen 指令 下 的 通信 连接 。 

(2) 如 果 省 略 了 视觉 传感器 编号 , 则 切断 所 有 视觉 传感器 的 通信 连接 。 

(3) 如 果 通 信 线 路 已 经 切断 , 则 转 和 人 下 一 步 。 

(4) 由 于 可 以 同时 连接 7 个 视觉 传感器 ,所 以 必须 按 顺序 编写 视觉 传感器 编号 ,这 样 可 
以 按 顺序 关 断 视觉 传感器 。 

(5) 如 果 执 行 本 指令 时 程序 被 删除 , 则 继续 执行 本 指令 直到 本 指令 处 理 的 工作 完成 。 

(6) 如 果 在 多 任务 中 使 用 本 指令 ,在 使 用 本 指令 的 任务 中 , 仅 需要 关闭 由 NVOpen 指 
令 打开 的 通信 线路 。 

(7) 不 支持 启动 条 件 为 Always( 上 电 启 动 ) 和 设置 为 “连续 功能 ”的 程序 。 

(8) 如 果 使 用 END 指令 ,所 有 由 NVOpen 或 Open 指令 开启 的 连接 都 会 被 切断 。 但 是 
在 调用 子 程序 指令 下 不 会 关 断 。 程 序 复 位 也 会 切断 通信 连接 ,所 以 在 程序 复位 和 END 指 


第 26 日 一 一 机 器 人 与 视觉 系统 


音 


章 


30 日 学 烧 工 业 机 器 人 


令 下 不 使 用 本 指令 也 会 切断 通信 连接 。 
(9) 如 果 在 执行 本 指令 时 ,有 某 个 中 断 程 序 的 启动 条 件 已 经 成 立 , 则 在 执行 完 本 指令 后 
才 执 行 中 断 程序 。 


和 


报警 


如 果 “ 视 觉 传感器 编号 ”超出 1 一 8 范围 , 则 会 出 现 * 超 范围 报警 。 


26.10.3 NVLoad 


1 


加 载 程序 指令 


功能 


加 载 指定 的 视觉 程序 到 视觉 传感器 。 


2. 


格式 


NVLoad #< 视 觉 传感器 名 称 >, "< 视觉 程序 名 称 >" 


3。 


术语 


< 视觉 程序 名 称 > 一 一 指 要 启动 的 视觉 程序 名 称 (已 经 存在 的 视觉 程序 名 称 可 以 省 略 )， 
只 可 以 使 用 0 一 9,A 一 Z,a 一 z，…-”, 以 及 下 夯 线 ””, 对 程序 进行 命名 。 


4. 


ou ww 


5. 


样 例 程序 

If M_NvOPen(1)<> 1 Then ' 一 一 判断 1# 视觉 传 感 器 是 否 联 机 完成 。 

NVOpen "COM2:" AS #1 ' 一 一 在 COM2 口 连接 视觉 传感器 并 将 其 设置 为 1# 传 感 器 。 
EndIf 

Wait M_NvOpen(1) = 1 ' 一 一 等 待 通信 连接 完成 。 

NVLoad # 1, "TEST"”' 一 一 加 载 Test 程序 。 

NVPst #1，""v"E76","J81"，"L84",0,10' 一 一 启动 #1 程序 并 获取 信息 。 


说 明 


(1) 本 指令 功能 为 加 载 指定 的 程序 到 指定 的 视觉 传感器 。 

(2) 在 加 载 程序 到 视觉 传感器 的 位 置 点 ,本 指令 将 移动 到 下 一 步 。 

(3) 如 果 执 行 本 指令 时 删除 了 程序 ,立即 停机 。 

(4) 如 果 指 定 的 程序 名 已 经 被 加 载 , 则 本 指令 立即 结束 不 做 其 他 处 理 。 

(5) 在 执行 多 任务 时 使 用 本 指令 ,必须 在 任务 区 执行 NVOpen 指令 ,同时 必须 用 
NVOpen 指令 指定 传感器 编号 。 

(6) 不 支持 启动 条 件 为 Always( 上 电 启 动 ) 与 设置 为 “连续 功能 ”的 程序 。 

(7) 如 果 在 执行 本 指令 时 , 某 个 中 断 程序 的 启动 条 件 成 立 , 则 立即 执行 中 断 程序 。 


26.10.4 NVPst 启动 视觉 程序 获取 信息 指令 

1. 功能 

启动 指定 的 视觉 程序 并 获取 信息 。 从 视觉 传感器 接收 的 数据 存储 于 机 器 人 控制 器 作为 
状态 变量 。 

2. 格式 


NVPst #< 视 觉 传感器 编号 >, "< 视觉 程序 名 称 >"，"< 存 储 识别 工件 数据 量 的 单元 格 号 >"，"< 开 始 单元 
格 编号 >"，"< 结 束 单元 格 编号 >"，< 数 据 类 型 > [， < 延迟 时 间 >] 


3. 术语 

(1) < 视觉 传感器 编号 >: 对 使 用 的 视觉 传感器 设置 的 编号 (不 能 省 略 ) ,设置 范围 1 一 8。 

(2) < 视觉 程序 名 称 >( 不 能 省 略 ): 设置 视觉 程序 名 称 。 已 经 加 载 的 视觉 程序 可 省 略 。 
只 有 0 一 9,A 一 Z,a 一 z,-”, 以 及 下 夯 线 ” ”等 字符 可 以 使 用 。 

(3) < 存储 识别 工件 数据 量 的 单元 格 号 >: 指定 一 个 单元 格 。 在 这 个 单元 格 内 存储 被 识 
别 的 工件 数量 。 设 置 范围 : 行 0 一 399, 列 A 一 Z, 例 如 A5。 

被 识别 的 “工件 数 ” 存 储 在 M_NvNum(* )(* 一 1 一 8) 。 

(4) < 开始 单元 格 编号 >/< 结 束 单元 格 编号 >( 不 能 省 略 ): 指定 (电子 表格 内 ) 视 觉 传 感 
器 识别 信息 的 存放 范围 (从 起 始 到 结束 )。 单 元 格 的 内 容 存 储 在 P_NvS* (30)、M_NvS* 
(30,10) .C_NvSx* (30,10)(* 一 1 一 8) 等 变量 中 。 

设置 范围 : 行 0 一 399 , 列 A 一 Z ,例如 A5, 如 图 26-10 所 示 。 

但 是 , 当 指 定 的 行为 30, 列 为 10 ,或 单元 格 总 数 超过 90 时 就 会 出 现 “ 设 置 的 单元 格 数 超 
出 范围 ?报警 。 


95 xX Y C Score x Y C 

96 | 马 Point 347.147| -20.232| -158.198 97.641|@Point 110.141| 120.141 72.645 
97 | 中 Point 381.288 49.018 10.846 97.048| 马 Point 89.582 99.582| -118.311 
98 | 马 Point 310.810 43.650| -34.312 0.000|3Point 139.151| 149.151| -163.469 


图 26-10 在 视觉 程序 内 的 电子 表格 及 单元 格 


(5) < 数据 类 型 >( 不 能 省 略 ) : 用 于 设置 所 获取 的 数据 类 型 。 所 获取 的 数据 类 型 有 位 置 
型 数据 , 单 精 度 实数 ,文本 型 数据 。 设 置 范围 为 0 一 7。 具 体 设置 见 表 26-3 。 


表 26-3 数据 类 型 设置 表 


设 定 值 0 ¥ 2 3 4 5 6 7 
单元 格 状态 一 个 数据 /单元 格 (每 个 单元 格 内 放 一 个 数据 ) (每 个 单元 格 内 放 两 个 或 更 多 个 数据 ) 
对 应 使 用 的 M_NVSO M_NVSO 
P_NVSO |M_NVSO | C_NVSO P_NVSQO |M_NVSO | C_NVSO 
状态 变量 C_NVSO C_NVSO 
单 精度 实数 ”位 置 型 | 单 精度 单 精度 实数 
数据 类 型 ”位 置 型 数据 单 精 度 实数 ”文本 型 文本 型 数据 实数 文本 型 文本 型 


(6) < 延迟 时 间 >: 本 指令 执行 的 时 间 。 


4. 样 例 程序 

第 
1 IfM NvOpen(1)<>1 Then 26 
2 NVOpen "COM2:" RS #1 章 


第 26 日 一 一 机 器 人 与 视觉 系统 


30 日 学 凤 工 业 机 器 人 


3 EndIf 


4 Wait M NvOpen(1)=1. 
5 NPst #1,"TEST","E76","J81", "L84",1,10 
一 一 启动 运行 TEST 程序 ,在 E76 单元 格 内 存放 识别 工件 数量 。 识 别 信息 存放 区 域 为 81 一 L84, " 数 
据 类 型 "为 " 单 精度 实数 "。 同 时 识别 信息 还 存放 在 机 器 人 状态 变量 M_NvS1() 中 。 
30 NVclose #1 ' 一 一 关闭 通信 线路 
5. 说 明 
(1) 本 指令 功能 为 启动 视觉 程序 并 接收 识别 信息 。 
(2) 在 延迟 时 间 内 ,直到 信息 接收 完成 之 前 ,不 要 移动 到 下 一 步 。 
注意 : 在 机 器 人 程序 停止 时 ,本 指令 立即 被 删除 。 程 序 重新 启动 后 ,继续 处 理 。 
(3) 如 果 指 定 的 程序 已 经 被 加 载 ,本 指令 无 须 加 载 程序 而 立即 执行 ,可 以 缩短 处 理 
时 间 。 
(4) 当 在 多 任务 状态 下 使 用 本 指令 时 ,必须 使 用 NVOpen 指令 。 
(5) 如 果 Type 设置 为 4 一 7, 则 可 以 提高 信息 接收 的 速度 。 
(6) 不 支持 启动 条 件 为 Always( 上 电 启 动 ) 和 设置 为 “连续 功能 ”的 程序 。 
(7) 如 果 在 本 指令 执行 过 程 中 ,有 任 一 中 断 程 序 执行 条 件 成 立 , 则 立即 执行 中 断 程序 。 
6. 多 通道 模式 的 使 用 方法 
当 使 用 多 通道 模式 时 ,根据 机 器 人 的 数量 设置 启动 单元 格 和 结束 单元 格 以 取得 信息 , 同 
时 “数据 类 型 ?设置 为 1 一 3。 
下 例 是 一 个 多 通道 模式 的 信息 处 理 方法 。 
如 图 26-11 所 示 ,设置 启动 单元 格 和 结束 单元 格 为 J96 一 M98, 则 给 第 一 个 机 器 人 的 信 
息 存储 在 视觉 程序 表格 J97 一 M98 中 。 


c Score 区 [Y C 
347.147 -158198| 97.641|®Point 110.141| 120.141| 72.645 
97|sPoint | 381288| 49.018| 10.846| 97.048|®Point 89.582| 99.582| -118.311 
98|5Point | 310.810| 43.650| -34.312| 0.000|®Point 139.151| 149.151| -163.469 


26-11 视觉 程序 电子 表格 信息 


传送 给 第 二 个 机 器 人 的 信息 存储 在 视觉 程序 表格 O97 一 R98 中 。 如 果 在 NVPst 指令 
中 设置 < 数据 类 型 >==1, 则 数据 被 存储 在 M_NVS1() 中 ,如 表 26-4 所 示 。 


表 26-4 M_NVS1() 中 的 实际 数据 


Column 
Row 

1 2 3 4 5 6 7 8 9 
1 347. 147 | 一 20. 232 | 一 158. 198| 97. 641 | 0.0 0.0 0.0 0.0 0.0 
2 381.288 | 49.018 10.846 | 97.048 | 0.0 0.0 0.0 0.0 0.0 
M_NVS10) 3 310. 81 43. 65 一 34. 312 0.0 0.0 0.0 0.0 0.0 0.0 

4 0.0 0.0 0.0 0.0 0.0 0 0 0 0 

5 0.0 0.0 0.0 0.0 0.0 0 0 0 0 


例如 ,如 果 为 2 通道 模式 ,< 启动 单元 格 > 一 J96 .< 结束 单元 格 > 一 R98,< 数 据 类 型 > 一 1， 
则 存储 在 M_NVS1(30,10) ,结果 如 表 26-5 所 示 。 


表 26-5 2 通道 模式 中 M_NVS1 的 数据 


Column 
Row 
1 2 3 4 5 6 7 8 9 

1 347. 147| 一 20. 232 | 一 158. 198|97. 641| 0.0 |110.141|120.141| 72.645 |97. 641 

2 381.288| 49.018 10.846 |97.048| 0.0 | 89.582 | 99. 582 | 一 118. 311| 97. 048 
M_NVS10) 3 310.81 | 43.65 一 34.312 | 0.0 0.0 |139.151|149. 151 | 一 163. 469| 95. 793 

4 0.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0 

5 0.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0 0.0 


一 台 视 觉 传感器 最 多 可 同时 连接 三 台 机 器 人 控制 器 ,不 过 本 指令 在 同一 时 间 只 能 使 用 
一 次 。 本 指令 可 以 用 于 任 一 机 器 人 控制 器 。 

7. 三 台 机 器 人 与 一 台 视 觉 传感器 构成 的 跟踪 系统 实例 

工作 步骤 如 下 ,如 图 26-12 所 示 。 

(1) 三 台 机 器 人 ,一 台 设 置 为 主 站 , 主 站 使 用 NVPST 指令 向 视觉 传感器 发 出 “拍照 请 
求 ”, 视 觉 传感器 启动 拍照 , 当 拍照 结束 后 ,将 数据 信息 传送 到 机 器 人 主 站 。 

(2) 主 站 机 器 人 发 出 “接收 通知 ?给 另外 两 台 机 器 人 (推荐 两 台 机 器 人 之 间 使 用 I/O 连 
接 , 另 一 台 机 器 人 使 用 以 太 网 连接 )。 

(3) 使 用 NVIN 指令 ,每 台 机 器 人 可 分 别 接收 各 自 的 信息 。 


视觉 传感器 
3 接收 数据 
3 接收 数据 


ra 


控制 器 控制 器 - 主 站 


2 可 接收 信号 通知 ] 2 可 接收 信号 通知 ] 


图 26-12 三 台 机 器 人 与 一 台 视 觉 传感器 构成 的 系统 


8. 两 台 机 器 人 与 一 台 视 觉 传感器 构建 系统 的 样 例 
工作 步骤 如 下 ,如 图 26-13 所 示 。 
(1) 当前 使 用 视觉 传感器 的 控制 器 首先 要 检查 视觉 传感器 没有 被 男 一 台 控 制 器 使 用 并 

向 另外 一 台 控 制 器 发 出 “在 使 用 中 ”的 信号 。 第 
(2) 向 视觉 传感器 发 出 “拍照 请 求 ”。 26 
(3) 当 视 觉 传感器 处 理 完 成 图 像 数 据 后 ,控制 器 就 接收 必要 的 数据 。 章 


第 26 日 一 一 机 器 人 与 视觉 系统 
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(4) 控制 器 关闭 “在 使 用 中 ”的 信号 并 输出 给 另外 一 控制 器 。 
(5) 另 一 台 控 制 器 执行 步骤 (1) 一 (4) 。 
用 这 种 方法 ,两 台 控制 器 能 够 交 蔡 使 用 一 台 视 觉 传感器 。 


视觉 传感器 


2 拍照 请 求 


控制 器 控制 器 


图 26-13 两 台 机 器 人 与 一 台 视觉 传感器 构成 的 系统 


26.10.5 NVIn 读 取 信息 指令 
1. 功能 
接收 来 自视 觉 传感器 的 识别 信息 ,这 些 识 别 信 息 被 保存 在 机 器 人 控制 器 中 作为 状态 变量 。 
2. 格式 


NVIn#< 视 觉 传 感 器 编号 >, "< 视觉 程序 名 称 >"， "< 存储 识别 工件 数据 量 的 单元 格 号 >"， "< 开始 单元 格 
编号 >", "< 结束 单元 格 编号 >"， < 数据 类 型 > [，< 延 迟 时 间 >] 


3. 样 例 程序 

1 If M_NvOpen(1)<>1 Then ' 一 一 判断 1# 传感器 是 否 联机 完成 , 如 果 没 有 联机 完成 , 就 连接 
到 "COM2:"。 

2 NVOpen "COM2:" RS #1 


3 EndIf 
4 Wait M NvOpen(1)=1 
5 NVRun 并 1,"TEST"” ' 一 一 启动 TEST 程序 。 

6 NIn #1, "TEST","E76","J81","L84",0,10'—— 

接收 信息 。 在 E76 内 存放 "工件 数量 "。J81~L84 存放 识别 的 数据 。 数 据 是 "位 置 变量 "。" 位 置 变量 " 
存储 在 P_NvS1(30) 中 。 

30 NVClose #1 ' 一 一 关闭 #1 文 件 。 


4. 说 明 

(1) NVI 指令 与 NVPST 指令 的 区 别 在 于 : NVIn 指令 仅仅 是 一 个 读 取信 息 的 指令 。 
而 NVPST 指令 是 先 启 动 程序 运行 再 读 取信 息 的 指令 。NVIn 指令 与 NVPST 指令 的 术语 
定义 完全 相同 。 

(2) 通过 设置 数据 类 型 ,将 读 取 的 信息 存放 在 P_NvS1(30) 中 。 


视觉 程序 启动 指令 


26.10.6 NVRun 


1. 功能 
启动 运行 指定 的 程序 。 
2. 格式 


NVRun #< 传 感 器 编号 >, "< 传感器 程序 名 >" 
3. 样 例 程序 


1 If M_NvOpen(1)<>1 Then ' 一 一 判断 1# 传感器 是 否 联机 完成 , 如 果 没 有 联机 完成 就 连接 
到 "COM2:"。 

2 NVOpen "COM2:" AS #1 ' 一 一 将 传感器 连接 到 通信 口 COM2 。 

EndIf 

Wait M_NvOpen(1) = 1 ' 一 一 等 待 联机 完成 。 

NVRun # 1 "TEST"”' 一 一 启动 运行 TEST 程序 。 

NVIn 1，"TEST","E76", "J81","L84",0,10 ' 一 一 输入 相关 数据 。 


请 求 拍 照 指令 


3 
4 
3 
6 


26.10.7 NVTrg 


1. 功能 
向 视 党 传感器 发 出 拍照 请 求 。 
2. 格式 
NVTrg #< 视 觉 传感器 编号 >,< 延 迟 时 间 >，< 存 放 1# 编码 器 数据 的 状态 变量 > [, [< 存放 2# 编码 器 数 
据 的 状态 变量 >][, [<< 存 放 3# 编码 器 数据 的 状态 变量 >] [, [<< 存 放 4# 编码 器 数据 的 状态 变量 >][， 
[< 存放 5# 编码 器 数据 的 状态 变量 >] 
[, [< 存放 6# 编码 器 数据 的 状态 变量 >][, [< 存放 7# 编码 器 数据 的 状态 变量 >] [, [< 存 
放 8# 编 码 器 数据 的 状态 变量 >] 
3. 术语 
(1) < Delay time > 延迟 时 间 : 从 向 传感器 发 出 拍照 指令 到 编码 器 数据 被 读 出 的 时 间 。 
设置 范围 0 一 150ms。 
(2) < 存放 N 井 编码 器 数据 的 状态 变量 >: 指定 一 个 双 精 度 变量 。 这 个 变量 存储 从 外 部 
编码 器 n 读 出 的 数据 ,n 一 1 一 8。 
4. 样 例 程序 
1 If M_NvOpen(1)<>1 Then ' 一 一 判断 1# 传感器 是 否 联机 完成 , 如 果 没 有 联机 完成 就 连接 
到 "COM2:"。 
2 NVOpen "COM2:" AS #1 
3 EndIf 
4 Wait M_NvOpen(1) = 1 一 一 等 待 联机 完成 。 
5 NVRun #1, "TEST"”' 一 一 运行 TEST 程序 。 
6 NVTrg 并 1,15, M1 并 ,M2 间 一 一 ' 请 求 1# 视 觉 传感器 拍照 并 在 15ms 后 将 编码 器 1 和 编码 器 2 的 值 
存储 在 变量 ML# 和 M2# 中 。 


26.10.8 P NvS1 一 P_NvS8 一 一 位 置 型 变量 


1. 功能 
26 
P_NvS* 是 以 位 置 数据 格式 保存 的 视觉 传感器 的 识别 信息 。 在 NVPst 指令 或 NVIn | 章 
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指令 中 ,设置 < type >=0 时 ,数据 以 X,Y,C 坐标 数据 的 格式 保存 识别 信息 ,也 就 是 “位 置 型 
样 例如 图 26-14 所 示 。 


95 区 Y C Score Y C 

96 |@Point 347.147 720.232| -158.198 97.641 |@Point 110.141 | 72.645 
97 |@Point 381.288 | 49.018 10.846 97.048|®Point 89.582 99.582| -118.311 
98 |saPoint 310.810 43.650| -34.312 0.000|BPoint 139.151 | -163.469 


26-14 ”视觉 程序 信息 表格 


在 NVPst 指令 或 NVIn 指令 中 ,设置 < 启动 单元 格 > 王 J96,< 结 束 单元 格 > 一 L98, 则 
P_NVS10O 如 下 (有 三 点 有 效 的 数据 ) 。 

P_NvS1(1) = (+347.14, -20.23, +0.00, +0.00, +0.00, -158.19, +0.00, +0.00)(0, 0) 

P_NvS1(2) = (+381.28, +49.01, +0.00, +0.00, +0.00, +10.84, +0.00, +0.00)(0, 0) 

P_NvS1(3) = (+310.81, +43.65, +0.00, +0.00, +0.00, -34.312, +0.00, +0.00)(0, 0) 


P_NvS1(4)=( +0.00, +0.00, +0.00, +0.00, +0.00, +0.00, +0.00, +0.00)(0, 0) 
P_NvS1(5) = ( +0.00, +0.00, +0.00, +0.00, +0.00, +0.00, +0.00, +0.00)(0, 0) 


P_NvS1(30)= ( +0.00, +0.00, +0.00, +0.00, +0.00, +0.00, +0.00, +0.00)(0, 0) 


要 注意 : 在 P_NvS1 * 位 置 数 据 中 ,没有 Z、A、B 及 第 7 轴 , 第 8 轴 数 据 , 直接 使 用 
P_NvSl * 要 特别 注意 检查 。 注 意 程序 样 例 中 的 处 理 方法 。 
2. 格式 


< 位 置 变量 > = P_NVS * (< 位 置 点 编号 >) 
* (一 8) :视觉 传感器 编号 。 


3. 术语 

< 位 置 点 编号 >: 1 一 30。 

4. 样 例 程序 

1 If M_NvOpen(1)<>1 Then ' 一 一 如 果 1# 传 感 器 通信 连接 未 完成 。 

2 NvOpen "COM2:" AS #1' 一 一 将 1# 传 感 器 连接 到 COM2 通信 口 。 

3 EndIf 

4 Wait M_NvOpen(1) =1 ' 一 一 等 待 1# 传 感 器 通信 连接 完成 。 

5 NvPst #1,"TEST", "E76", "J96","L98",0,10 ' 一 一 读 取 的 数据 存放 在 P_NvS1 ()。 
6 MvCnt =M_NvNum(1) 一 一 以 "检测 到 的 工件 数量 "设置 为 MvCnt。 

7 For MCnt = 1 To MvCnt ' 一 一 以 "检测 到 的 工件 数量 "编制 一 个 循环 程序 。 

8 P10=Pl 一 一 赋值 。 

9 P10=P10xP_NvS1(MCnt) ' 一 一 将 P10 * P_NvS1(MCnt) 相 乘 获得 完整 位 置信 号 。 
10 Mov P10, - 50 ' 一 一 前 进 到 P10 点 的 近 点 。 

11 Mvs P10 ' 一 一 前 进 到 P10 点 。 


12 HClose 1 ' 一 一 抓 手 动作 。 
13 Mvs P10, - 50 一 一 前 进 到 P10 点 的 近 点 。 
14 Next MCnt' 一 一 循环 语句 。 
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10.9 M_NvyNum 一 一 状态 变量 
1. 功能 

存储 视觉 传感器 检测 到 的 工件 数量 (0 一 255 ) 。 
2. 格式 

< 数字 变量 > = M_NVNUM (< 传感器 编号 >) 

3. 术语 

< 数字 变量 >: 设置 需要 使 用 的 数字 变量 。 

4. 样 例 程序 


1 If M_NvOpen(1)<>1 Then ' 一 一 如 果 1# 传 感 器 通信 连接 未 完成 。 


NvOpen "COM2:" AS #1 ' 一 一 将 1# 传 感 器 连接 到 COM2 通信 口 。 

EndIf 

Wa 让 M_NvOpen(1) =1 等 待 联机 完成 

NvPst #1, "TEST","E76","J81"，,"L84",1,10' 一 一 运行 TEST 程序 并 读 信息 。 
MvCnt = M_NvNum(1) ' 一 一 将 1# 视 觉 传感器 检测 到 的 工件 数量 赋值 到 MvCnt。 


5. 说 明 
(1) M_NvNum 是 一 个 状态 变量 ,用 于 表示 执行 NVPst 指令 或 NVIn 指令 时 ,视觉 传 


ou wb 


感 器 检测 到 的 工件 数量 。 


26. 


(2) 存储 的 识别 数量 数据 会 一 直 保 存 ,直到 执行 下 一 个 NVPst 指令 或 NVIn 指令 。 


10.10 M_NvOpen 状态 变量 


1. 功能 

存储 视觉 传感器 通信 连接 状态 。 在 NVOpen 指令 之 后 ,检查 通信 连接 是 否 连 接 完成 。 
M_NVOPEN==0 一 一 未 连接 完成 ; 

M_NVOPEN=1 一 一 连接 完成 ; 

M_NVOPEN==-1 一 一 未 连接 。 

2. 格式 

< 数字 变量 > = M_NVOPEN (< 视觉 传感器 编号 >) 


3. 样 例 程序 


1 If M_NvOpen(1)<>1 Then ' 一 一 判断 : 如 果 1# 视觉 传 感 器 没有 连接 。 

2 NvOpen "COM2:" AS #1 ' 一 一 将 视觉 传感器 连接 到 COM2 口 并 设置 为 1# 视 觉 传 感 器 。 
3 EndIf 

4 Wait M_NvOpen(1) = 1 一 一 等 待 连接 完成 。 


4. 说 明 
初始 值 M_NvOpen 一 一 1, 在 执行 NVOpen 指令 时 ,M_NvOpen 一 0, 表 示 通 信 线 路 未 连 站 
接 完成 ,随后 M_NvOpen 王 1, 表 示 联 机 完成 。 章 
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26.11.11 M_NvS1 一 M_NvS8 一 一 视觉 传感器 识别 的 数值 型 变量 


1. 功能 

M_NvS* 是 状态 变量 。M_NvS* 以 数字 格式 存储 视觉 传感器 的 识别 数据 。 在 NVPst 
指令 或 NVIn 指令 中 ,如 果 设 置 < type>=1,3.5,7, 则 其 指定 范围 内 的 识别 信息 被 转换 为 数 
值 并 存储 。 

在 图 26-15 上 部 ,是 视觉 程序 所 获得 的 识别 信息 。 使 用 NVPst 指令 或 NVIn 指令 , 设 
置 < 启动 单元 格 > 一 J96 ,< 停止 单元 格 > 一 L98 。 

这 样 在 状态 变量 M_NvS* 中 ,其 对 应 的 数据 如 图 26-15 下 部 所 示 。 


区 MY IC Score x |Y C 
96 |®Point 347.147| -20.232| -158.198 97.641 |BPoint 110.141| 120.141 72.645 
97 |aPoint 381.288 49.018 10.846 97.048|3Point 89.582 99.582| -118.311 
98 | 马 Point 310.810 43.650| -34.312 0.000|@Point 139151| 149.151| -163.469 


wr | 本 | 


0.0 | 139.151 149.151 
0.0 |0.0 | 
0 100 ) 


图 26-15 视觉 识别 信息 与 变量 的 关系 


1 2 3 | 4 
-20.232 


-118.311 | 0.0 


2. 格式 
< 数字 变量 > = M_NVS * (< 行 编号 >，< 列 编号 >) 


x (一 8) :视觉 传感器 编号 。 

注意 ; M_NvS* 与 P_NvS* 的 区 别 在 于 ,P_NvS* 是 一 个 “位 置 型 变量 ”, 可 以 表示 一 
个 位 置 点 。 而 M_NvS * 只 是 表示 电子 表格 中 一 个 单元 格 的 数据 。 请 注意 样 例 程序 中 的 
用 法 。 

3. 样 例 程序 


1 IfM NvOpen(1)<>1 Then 

2 NvOpen "COM2:" AS #1 

3 EndIf 

4 WaitM NvOpen(1)=1 

5 NvPst #1, "TEST","E76","J96","098"0.1,10 ' 一 一 数据 类 型 = 1, 获取 的 数据 存放 在 M_NVS1()。 
6 MvCnt = M_NvNum(1) ' 一 一 获取 视觉 传感器 检测 到 的 工件 数 。 

天 

8 


For MCnt = 1 To MvCnt ' 一 一 循环 。 

P10 = P1 一 一 赋值 计算 。 
9 P10.X=M_NvS1(MCnt,1) ' 一 一 指定 M_NvS1() 第 1 行 第 1 列 的 数据 = P10.X。 
10 P10.Y=M NvS1(MCnt,2) 一 一 指定 M_NvS1() 第 1 行 第 2 列 的 数据 = P10.Y。 


11 P10.C=M NvS1(MCnt, 3) * 指定 M_NvS1() 第 1 行 第 3 列 的 数据 = P10.C。 
12 Mov P10, - 50 ' 一 一 前 进 到 P10 点 的 近 点 。 


13 Mvs P10 一 一 前 进 到 P10 点。 

14 HClose 1 ' 一 一 抓 手 动作 。 

15 Mvs P10, - 50 一 一 前 进 到 P10 点 的 近 点 。 

16 Next MCnt' 一 一 下 一 循环 。 在 下 面 的 循环 中 ,MCnt = 2,3,4。 


4. 说 明 

(1) M_NvS* 中 的 数据 会 一 直 保 持 直 到 执行 下 一 个 NVPst 指令 或 NVIn 指令 。 但 是 
在 断 电 ,执行 END 指令 ,程序 reset 指令 时 ,M_NvSx* 的 数据 会 被 清 零 。 

同时 ,如 果 < 数 据 类 型 > 设置 不 是 1,3,5,7,M_NvSx* 的 数据 会 被 清 零 。 

(2) 如 果 识 别 的 数据 是 字符 串 ,M_NvS* 的 数据 会 被 清 零 。 


26.10.12 EBRead 读数 据 指 令 ( 康 村 斯 专用 ) 


1. 功能 

读 出 指定 视觉 传感器 的 数据 。 这 些 数据 被 存储 在 指定 的 变量 中 。 本 指令 专用 于 康 奈 斯 
公司 的 EB 软件 制作 的 视觉 程序 。 

2. 格式 


EBRead #< 视 觉 传感器 编号 >, [< 标签 名 称 >], < 变量 1 > [ ,< 变量 1 2>] …[ ,< 延迟 时 间 >] 


3. 术语 

视觉 程序 名 : 指定 视觉 程序 名 。 读 出 该 程序 内 存储 的 数据 。 如 果 省 略 视 觉 程序 名 , 则 
要 在 参数 EBRDTAG 内 设置 。 初 始 值 为 "Job. Robot. FormatString"。 

延迟 时 间 : 设置 范围 1 一 32 767s。 

4. 样 例 程序 


100 If M_NvOpen(1)<>1 Then 
110 NVOpen "COM2:" Rs #1 


120 End If 
130 Wait M_NvOpen(1) =1' 一 一 等 待 联 机 完成 。 

140 NVLoad #1,"TEST" ' 一 一 加 载 TEST 程序 。 

150 NVRun #1,"TEST" ' 一 一 运行 TEST 程序 。 

160 EBRead #1,,MNUM, PVS1, PVS2 ' 一 一 读 出 程序 名 为 Job. Robot. FormatString 内 的 数据 。 将 这 些 数 
据 存储 在 指定 的 变量 中 。 

5. 说 明 


(1) 本 指令 用 于 读 取 数 据 。 
(2) 数据 存储 在 指定 的 变量 中 。 
(3) 变量 用 逗号 分 隔 ,数据 按 变量 排列 的 顺序 存储 ,因此 读 出 数据 的 类 型 要 与 指定 变量 
的 类 型 相同 。 
(4) 当 指定 变量 为 位 置 型 变量 时 ,存储 的 数据 为 X\Y、C, 而 其 他 各 轴 的 值 为 "0"。C 值 
的 单位 为 弧度 。 
(5) 当 指定 的 变量 数 少 于 接收 数据 时 , 则 接收 的 数据 仅 存储 在 指定 的 变量 中 。 
(6) 当 指定 的 变量 数 多 于 接收 数据 时 , 则 多 出 的 数据 部 分 不 上 传 。 26 
(7) 如 果 省 略 视觉 程序 名 称 则 默认 为 参数 EBRDTAG 的 初始 值 Job. Robot. FormatString。 | 章 
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(8) 在 延迟 时 间 内 不 要 移动 到 下 一 步 , 必 须 等 到 数据 读 出 完成 。 注 意 , 如 果 机 器 人 程序 
停止 ,本 指令 立即 被 删除 ,需要 用 重启 指令 继续 执行 本 指令 。 

(9) 多 任务 时 必须 使 用 NVOpen 指令 和 NVRun 指令 ,在 相关 的 任务 区 程序 内 指定 视 
觉 传 感 器 的 编号 。 

(10) 不 支持 启动 条 件 为 *Y 上 电 启 动 " 和 连续 功能 的 程序 。 

如 果 执 行 本 指令 时 , 某 一 中 断 程序 的 条 件 成 立 , 则 立即 执行 中 断 程序 。 待 中 断 程序 执行 
完毕 后 青 执行 本 指令 。 

为 了 缩短 生产 时 间 ,可 以 在 执行 NVRun 指令 和 EBRead 后 执行 其 他 动作 。 

如 果 在 执行 NVRun 指令 后 立即 执行 EBRead 指令 ,必须 设置 参数 NVTRGTMG =1。 

如 果 参 数 NVTRGTMG 二 出 厂 值 , 则 在 执行 NVRun 指令 后 的 下 一 个 程序 无 须 等 待 视 
觉 程序 的 处 理 完 成 即 可 执行 。 

如 果 在 NVRun 和 EBRead 之 间 ,程序 停止 , 则 执行 NVRun 指令 和 EBRead 指令 的 结 
果 可 能 不 同 。 

6. 指令 样 例 

变量 值 : 执行 EBRead 指令 的 变量 如 下 。 

(1) 如 果 视 觉 程序 的 内 容 是 10, 则 : 

@ 执行 “EBRead #1,"Pattern_1. Number_Found" ,MNUM 指令 后 ,MNUM==10。 

@ 执行 “EBRead #1,"Pattern_1. Number_Found" ,CNUM” 指 令 后 ,CNUM=10。 

(2) 如 果 执 行 视觉 程序 Job. Robot. FormatString 的 内 容 为 : 


2, 125.75, 130.5, —117.2, 55.1, 0, 16.2, 


@ 执行 “EBRead #1,,MNUM,PVS1,PVS2” 后 ,MNUM=2。 


PVS1.X= 125.75 PVS1.Y¥=130.5 PVS1.C=-117.2 

PVS2.X=55.1 PVS2.Y=0 PVS2.C= 16.2 

其 他 轴 数 据 一 0。 

注意 : PVS1,PVS2 是 位 置 型 变量 ,所 以 读 出 的 数据 为 “位 置 点 数据 ”。 

@ 执行 “EBRead #1,,MNUM,MX1,MY1,MC1,MX2,MY2,MC2” 后 ,MNUM 一 2。 


MX1 = 125.75 NMY1 =130.5 NMCL =- 117.2 
MX2 = 55.1 MY2=0 MC2= 16.2 


注意 : MX1,MY1,MC1 是 数据 型 变量 ,所 以 读 出 的 数据 为 “数字 ”。 
@ 执行 “EBRead #1,,CNUM,CX1,CY1,CC1,CX2,CY2,CC2” 后 ,CNUM 一 "2"。 


CR m "25. 75 CE 1390.5” CC1i=" = 317.2" 

Ci2= "55.1" CY2= "0" CC2 = "16.2" 

注意 : CX1,CY1,CC1 是 字符 串 型 变量 ,所 以 读 出 的 数据 为 “字符 串 。 
(3) 如 果 执 行 视觉 程序 Job. Robot. FormatString 的 内 容 为 


2; 125.75, 130.5 


则 执行 “EBRead #1,,;MNUM,PVS1” 后 ,MNUM==2。 


PVS1.X=125.75 PVS1.Y=130.5 


其 他 轴 数 据 二 0。 


26.11 需要 思考 的 问题 


(1) 机 器 人 和 视觉 系统 通过 什么 方式 连接 ? 如 何 设置 IP 地 址 ? 
(2) 如 何 使 用 RT 软件 进行 视觉 标定 ? 

(3) 如 何 使 用 NVOpen 指令 ? 

(4) 如 何 使 用 NVPST 指令 ? 

(5) NVIN 指令 有 什么 特点 ? 

(6) 如 何 使 用 EBread 指令 ? 
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害 2/ 蛙 视觉 系统 联合 应 用 


【学 习 目 的 】 
在 第 26 章 学 习 了 机 器 人 与 视觉 系统 联合 应 用 的 基本 理论 知识 和 相关 指令 。 内 容 较 多 ， 
本 章 学 习 实 际 的 应 用 案例 ,可 结合 第 26 章 的 内 容 进行 学 习 。 


27.1 案 例 1 


1. 工 况 状态 及 要 求 

在 图 27-1 中 ,工件 放置 的 “标准 位 置 的 缺口 是 垂直 方向 (设置 为 0" 位 置 )。 同 时 要 求 经 
过 机 器 人 搬运 到 下 一 工 位 后 ,工件 的 放置 位 置 仍然 为 缺口 为 0" 的 位 置 。 但 是 工件 的 实际 上 
料 位置 可 能 千变万化 (缺口 位 置 可 能 是 任意 角度 ) ,所 以 用 视觉 系统 获得 工件 的 实际 上 料 位 
置 ,其 工作 流程 如 图 27-2 所 示 。 


工件 形状 | 1. 抓 取 工 件 2. 识别 工件 3. 补偿 后 放置 
图 27-1 抓 取 工 件 工作 流程 


玩 取 人 要 .7 、 [XE 
PPICK < [LPPLACK 


1. 工 件 抓 取 2. 工件 识 别 。 3. 补偿 后 放置 
图 27-2 抓 取 工 件 工作 流程 中 的 各 位 置 点 


2. 解决 问题 的 思路 

在 图 27-1 中 ,工件 放置 的 标准 位 置 的 缺口 是 垂直 放置 的 ,但 是 实际 上 料 位 置 可 能 千 变 
万 化 。 解 决 问题 的 思路 是 使 用 视觉 相机 拍摄 被 抓 取 工件 的 实际 位 置 。 求 出 标准 位 置 数据 与 
实际 位 置 数据 的 偏差 量 , 将 该 偏差 量 作为 后 续 定位 位 置 的 补偿 量 。 

在 这 种 方法 中 ,关键 是 如 何 计 算 偏 差 量 。 
图 27-3 是 计算 偏差 量 的 示意 图 。 其 实 * 标 准 位 置 
数据 PVSCHK” 和 “视觉 相机 拍摄 获得 的 数据 机 器 人 原点 
PVSO” 都 是 以 机 器 人 坐标 系 确定 的 数据 。 通 过 
空间 位 置 点 的 计算 就 可 以 获得 这 两 个 位 置 点 之 间 
的 “偏差 量 ”"(PH=Inv(PVS0) XPVSCHK)。 

在 图 27-2 和 图 27-3 中 ,各 点 位 的 意义 如 下 。 

PVSCHK 一 一 拍摄 位 置 的 标准 位 置 点 。 用 


JOG 示 教 获得 。 视觉 传感器 识别 区 域 
PVS0 一 一 拍摄 位 置 的 实际 位 置 点 。 用 相机 图 27-3 计算 “偏差 量 " 示 意图 


PH 一 一 偏差 量 。 计 算 获 得 。 

PPICK 一 一 抓 料 点 位 置 。 

PPLACE 一 一 下 一 工 位 放置 点 的 位 置 。 

3. 操作 方法 

(1) 在 相机 拍摄 位 置 先 用 JOG 方式 标定 标准 位 置 的 坐标 。 

(2) 运行 视觉 程序 获得 工件 的 实际 位 置 。 

(3) 编写 程序 计算 偏差 量 。 

(4) 在 最 后 的 放置 工件 位 置 补偿 这 个 偏差 量 。 这 样 就 得 到 了 正确 的 放置 工件 位 置 。 
4. 拍照 获取 数据 并 计算 偏差 量程 序 

根据 图 27-2 和 图 27-3, 步 又 如 下 。 

步 又 1， 

1 Mov PHOME' 一 一 移动 到 待机 位 置 。 

2 ”Mov PPICK, -50' 一 一 移动 到 抓 料 位 置 上 方 。 
3 ”Mvs PPICK' 一 一 移动 到 抓 料 位置 。 

4 Dly 0.5' 一 一 暂停 0.5 秒 。 

5 HClose 1 ' 一 一 抓 手 = ON。 

6 Dly 0.5' 一 一 暂停 0.5 秒 。 

7 Mvs PPICK, - 50 ' 一 一 移动 到 PPICK 点 的 近 点 。 
8 ”Mov PVSCHK' 一 一 移动 到 拍照 位 置 。 

9 Dly 0.5' 一 一 暂停 0.5 秒 。 

10 Hlt ' 一 一 暂停 。 


步 又 2: 


11 If M_NvOpen(1) <> 1 Then' 一 一 判断 是 否 联 机 通信 。 

12 NVOpen "COM2:" As #1' 一 一 设置 "COM2:" 为 通信 口 , 并 将 从 "COM2:" 输 入 的 文件 作为 #1 文件。 
13 Wait M_NvOpen(1) =1' 一 一 等 待 联机 完成 。 

14 EndIf' 一 一 判断 语句 结束 。 
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15 NVRun # 1,"sample. job"' 一 一 运行 视觉 程序 。 

16 EBRead 并 1, ,MNUM, PVS ' 一 一 读 取 视觉 识别 信息 。 

17 If MNUM = 0 Then * VS_MISS' 一 一 如 果 无 法 识别 就 跳 转 到 报警 程序 。 

18 PVS0 = P_Zero' 一 一 对 PVS0 清 零 。 

19 PVS0 = PVS 一 一 设置 PVS0 为 识别 点 位 置 。 

20 PVS0. FL1 = PVSCHK. FL1' 一 一 设置 PVS0 的 位 置 结构 标 志 与 标准 位 置 相同 。 
21 PH = Inv(PVS0) * PVSCHK' 一 一 计算 偏差 量 。 重 要 ! 

22 Hlt ' 一 一 暂停 。 


P_01 = PVSCHK' 一 一 设置 各 有 关 点 为 全 局 变量 。 
23 P_02= PH' 一 一 注意 这 是 偏差 量 。 

24 P_03 = PPLACE' 一 一 放置 位 置 。 

25 P_04 = PHOME' 一 一 原点 位 置 。 

26 P_05 = PPICK' 一 一 抓 取 点 位 置 。 

27 Hlt' 一 一 暂停 。 

28 End' 程序 结束 。 

29 'xxxx ERROR 报警 子 程序 关 关 关 关 关 

30 * VS_MISS' 一 一 程序 分 支 标 志 。 

31 Error 9001' 一 一 报警 9001 。 

32 GoTo x VS_MISS' 一 一 跳 转 到 * VS_MISS 行 。 
33 Return' 子 程序 结束 。 


5. 说 明 

(1) NVRun 命令 紧 接着 为 EBRead 命令 时 ,必须 设置 参数 NVTRGTMG=1。 

如 果 参 数 NVTRGTMG 为 出 厂 设 定 (NVTRGTMG 二 2) 时 ,NVRun 命令 不 等 待 视觉 
识别 处 理 结束 就 执行 下 一 条 命令 ,因此 紧 接着 执行 EBRead 命令 的 话 , 有 可 能 会 读 出 上 一 次 
的 识别 结果 。 

(2) 执行 EBRead 命令 时 ,识别 结果 (识别 工件 数 ) 保 存 至 变量 NMUM 中 ,工件 的 识别 
位 置 (X、Y、C) 保 存 至 变量 PVS 中 。 识 别 结果 NG 或 识别 数量 为 0 时 ,会 进行 报警 处 理 。 

(3) 在 识别 的 角度 数据 的 符号 颠倒 的 情况 下 ,请 追加 如 下 处 理 。 


PVSO0.C=PVS.C*(-1) 


(4) 由 于 步骤 1 中 使 用 的 变量 需要 传送 给 步骤 2, 使 用 了 全 局 变量 。 本 程序 中 ,使 用 
P_01 一 P_05。 全 局 变量 在 本 工程 的 所 有 程序 中 都 生效 ,使 用 时 务必 注意 。 
6. 应 用 偏差 量 进行 补偿 的 搬 送 程序 


1 PVSCHK = P_01' 一 一 代入 相关 变量 。 
2 PH=P_02' 一 一 代 人 相关 变量 。 

3 ”PPLACE = P_03' 一 一 代入 相关 变量 。 
4 ”PHOME =P_04' 一 一 代入 相关 变量 。 


5 PPICK = P_05' 一 一 代入 相关 变量 。 

6 ”Mov PHOME' 一 一 移动 到 待机 点 。 

7 Dly 0.5' 一 一 暂停 0.5 秒 。 

8 HOpen 1' 一 一 抓 手 张 开 。 

9 If M_NvOpen(1) <> 1 Then' 一 一 判断 通信 连接 状态 。 


10 NVOpen "COM2:" As #1 一 一 设置 "COM2: "为 通信 口 , 并 将 从 "COM2:" 输 入 的 文件 作为 井 1 文件 。 
11 Wait M_NvOpen(1) =1' 一 一 等 待 连接 完成 。 

12 EndIf' 一 一 判断 语句 结束 。 

13 Mov PPICK, - 50' 一 一 移动 到 取 料 点 上 方 。 

14 ”Mvs PPICK' 一 一 移动 到 取 料 点 。 

15 Dly 0.5' 一 一 暂停 0.5 秒 。 

16 HClose 1' 一 一 抓 手 闭 合 。 

17 Dly0.5' 一 一 暂停 0.5 秒 。 

18 Mvs PPICK, - 50' 一 一 移动 到 取 料 点 上 方 。 

19 Mov PVSCHK' 一 一 移动 到 拍照 位 置 。 

20 Dly0.5' 一 一 暂停 0.5 秒 。 

21 NVRun #1,"sample. job"' 一 一 运行 视觉 程序 。 

22 ”EBRead 并 1,,MNUM, PVS' 一 一 读 出 视觉 识别 信息 * 1。 

23 If MNUM = 0Then * VS_MISS' 如 果 无 法 识别 就 跳 转 到 报警 程序 。 
24 ”PVS1 = P_Zero' 一 一 对 PVS1 进行 初始 化 设置 。 

25 PVS1 = PVS * 2' 一 一 对 PVS1 进行 设置 。 

26 PVS1. FL1 = PVSCHK. FL1' 一 一 对 PVS1 进行 设置 。 

27 PPLACE1 = PPLACE * PH' 一 一 关键 ! 对 工件 放置 位 置 进行 补偿 (位 置 点 乘法 运算 ) 。 
28 Mov PPLACE1, - 50' 一 一 移动 到 放置 点 上 方 。 

29 Mvs PPLACE1' 一 一 移动 到 放置 点 。 

30 Dly0.5' 一 一 暂停 0.5 秒 。 

31 HOpenl1' 一 一 抓 手 张 开 。 

32 Dly0.5' 一 一 暂停 0.5 秒 。 

33 Mvs PPLACE1, -50' 一 一 移动 到 放置 点 上 方 。 


34 Mov PHOME' 移动 到 PHOME 点 。 
35 Hlt' 一 一 暂停 。 
36 End 


37 ' 关 关 关 关 区 RROR 关 关 关 关 关 
38 * VS_MISS' 一 一 程序 分 支 标志 。 
39 Error9001' 一 一 报警 9001。 


40 GoTo * VS_MISS ' 一 一 跳 转 到 " x VS_MISS" 行 。 
41 Return ' 一 一 子 程序 结束 。 
7. 说 明 


(1) 视觉 程序 Job 的 识别 结果 (识别 工件 数 ) 保 存 至 变量 NMUM 中 ,将 工件 的 识别 位 
置 (X,Y,C) 保 存 至 变量 PVS 中 。 识 别 结果 NG 或 识别 数量 为 0 时 ,会 进行 报警 处 理 。 
(2) 在 识别 的 角度 数据 的 符号 颠倒 的 情况 下 .需要 追加 如 下 处 理 。 


PVS0.C= BEVS.Cx (—1) 


8. 操作 方法 

步骤 1: 

(1) 在 工件 识别 的 面 贴 上 画 有 十 字 线 的 纸 ,然后 使 用 机 器 人 抓 取 工件 。 

(2) 设 定 工具 点 使 纸 上 画 的 十 字 线 的 交点 成 为 旋转 中 心 。 

(3) 机 器 人 抓 住 工件 向 拍照 位 置 移 动 , 使 工件 上 的 十 字 线 与 相机 镜头 对 焦 。 对 焦 完 成 
后 的 位 置 即 为 位 置 变量 PVSCHK。 


(4) 进行 位 置 变量 PVSCHK 确认 的 同时 ,实施 视觉 传感器 的 N 点 校准 (2D 校准 ) 。 区 
(5) 打开 抓 手 取 出 工件 ,设置 工件 抓 取 位 置 。 章 
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(6) 机 器 人 抓 取出 工件 的 位 置 即 为 位 置 变量 PPICK 。 

(7) 将 待机 位 置 设置 为 位 置 变量 PHOME。 

(8) 执行 自动 运行 ,运行 至 Hlt 停止 。 

步骤 2: 

(1) 使 用 示 教 单元 打开 程序 ,JOG 运行 使 十 字 线 再 次 对 焦 , 再 次 示 教 位 置 变 量 
PVSCHK. 

(2) 对 焦 完 成 后 制作 工件 识别 Job 并 保存 。 

(3) 使 视觉 传感器 在 线 , 自 动 运行 至 停止 。 运 行 视觉 程序 并 执行 读 取 指 令 EBREAD 后 
的 数据 如 图 27-4 所 示 。 


000, 845.376,1004.368,0 


人 人。 
i ,NUM ,PYS 1 
MNUM=1, PYS.X=382 .97、 PYS.Y=92.39, PYS.. C05. 机 
读 入 。 


27-4 视觉 程序 信息 


步骤 3: 
(1) 使 用 TB 打开 程序 ,通过 JOG 运行 将 工件 的 放置 位 置 示 教 为 位 置 变量 PPLACE。 
(2) 放 开 工件 ,将 机 器 人 移动 至 待机 位 置 , 保 存 程序 。 


27.2 案 例 2 


1. 工 况 要 求 

如 图 27-5 所 示 , 工作 要 求 为 在 工件 A 上 安装 工件 B, 由 机 器 人 夹 持 工 件 B 安装 在 工件 
A 上 。 

工件 A 由 其 他 设备 上 料 , 每 次 工件 A 的 实际 位 置 与 理想 基准 位 置 都 会 发 生 偏差 ,所 以 
要 靠 视觉 照相 机 获得 实际 的 位 置信 息 。 

在 图 27-5 中 有 几 个 重要 的 位 置 点 , 现 说 明 如 下 。 

P_20 一 一 基准 标志 点 。 工 件 A 在 理想 基准 位 置 的 照相 标志 点 

PA1 一 一 基准 安装 工作 点 。 min 

PLN 一 一 实际 标志 点 。 工 件 A 在 实际 位 置 的 照相 标志 

PACT 一 一 实际 安装 工作 点 。 工 件 A ser 


实际 上 料 位 置 


实际 拍照 
标志 点 位 置 


工件 A PA P_20 
标准 工件 位 置 
(es [ 作 点 位 置 】 ( | 


图 27-5 工 况 示意 图 


由 于 照相 机 安装 在 机 器 手 上 ,所 以 拍照 标志 点 与 实际 抓 手 工作 点 不 是 一 个 点 。 这 是 
P_20 与 PA1 的 区 别 和 不 同 用 途 。 

如 图 27-5 所 示 ,每 次 上 料 后 ,工件 A 的 基准 标志 点 P_20 偏 移 到 PLN 点 。 这 样 工件 B 
的 实际 安装 点 就 移动 到 PACT 点 。 视 觉 照 相机 的 功能 就 是 要 获得 PLN 点 的 坐标 值 。 

2. 解决 方案 

(1) 预先 测 得 基准 标志 点 P_20 坐标 以 及 基准 工作 点 PACT 坐标 ,计算 出 这 两 点 之 间 
的 关系 (由 于 照相 机 安装 在 机 器 手 上 ,所 以 拍照 标志 点 与 实际 抓 手 工作 点 不 是 一 个 点 )。 


PAl=P 20*P_22 


P_22 一 一 根据 P_20 点 与 PA1l 点 相对 位 置 求 出 。 设 置 为 全 局 变量 ,便于 使 用 。 
(2) 通过 每 次 拍照 获得 实际 标志 PLN 点 的 坐标 值 。 
(3) 计算 获得 实际 安装 点 坐标 。 


PRCT = PLN*P 22 


3. 操作 步 又 

(1) 确认 工件 上 的 基准 拍照 标志 点 。 用 示 教 单元 获取 该 点 的 位 置 坐标 ,并 命名 为 P_20。 
(2) 确认 工件 上 的 基准 安装 点 。 用 示 教 单元 获取 该 点 的 位 置 坐标 ,并 命名 为 PA1。 
(3) 根据 PA1= 二 P_20 x P_22 公式 ,计算 出 P_22。 

(4) 移动 机 器 人 到 拍照 位 ,拍照 并 读 取 视觉 信息 ,获得 PLN 点 坐标 值 。 

(5) 根据 PACT= 二 PLN * P_22 计算 出 实际 安装 点 位 置 。 


4. 机 器 人 程序 

1 “一 一 判断 位 置 回 安 全 高 度 。 

2 Servo On 伺服 ON。 

3 If P_Curr.Z>850 Then 一 一 判断 当前 位 置 点 的 Z 轴 坐标 是 否 大 于 850, 如 果 大 于 则 

4 0vrd 20 ' 一 一 设置 速度 倍率 。 

5 “phome = P_Curr ' 一 一 定义 phome 为 当前 位 置 。 

6 phome.Z= 800 ' 一 一 定义 phome 的 高 度 为 800mm。 

7 Mvs phome ' 一 一 上 升 回 800m 高 度 。 第 
8 EndIf' 一 一 判断 语句 结束 。 27 
9 GoTo * get1' 一 一 跳 转 到 * getl 行 。 章 
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0 "= 通信 并 接收 数据 -一 

程序 分 支 标志 。 

12 NVOpen "COM3:" As #1 一 一 将 1# 视 觉 传感器 与 通信 口 3 建立 通信 通道 。 
13 Wait M_NvOpen(1) =1 ' 一 一 等 待 通信 接口 联机 完成 。 


11 关 Comm 


14 NVLoad #1, "MEF1" ' 一 一 加 载 程序 AF1。 

15 NVRun 间 1,"AF1"' 一 一 启动 相机 的 程序 。AF1 是 视觉 传感器 用 程序 名 。 
16 DLY 0.5" 暂停 0.5 秒 。 

17 NVIn #1,"AF1", "J21", "K21", "M21",0,10 一 一 读 取 位 置 型 数据 。 


18 GoSub * data ' 一 一 跳 转 子 程序 * data。 
19 GoTo * putfsl ' 一 一 跳 转 到 * putfsl 行 。 
20 Hlt “一 一 暂停 ,等 待 START 再 启动 。 
21 End “一 一 主 程序 结束 。 

22 * data' 一 一 数据 整定 。 


23 PLN= P_NvS1(1) ' 一 一 PLN 为 实际 标志 点 视觉 信息 数据 。 

27 PRCT = PLN * P_22.' 一 一 获得 实际 安装 工作 点 位 置 数据 (位 置 点 乘法 运算 ) 。 

36 Return ”一 一 返回 。 

3 取 抓 手 138 * getl 。 

39 Mov phandlget + ( + 0.00, +0.00, - 200.00, +0.00, +0.00, +0.00) 一 一 移动 。 

40 Ovrd 40 ”一 一 速度 倍率 40% (速度 ) 。 

41 Dly 0.5 一 一 暂停 0.5 秒 。 

42 Mvs phandlget + ( + 0.00, +0.00, -50.00,+0.00,+0.00,+0.00) ' 一 一 移动 到 抓 取 1 号 抓 
手 上 方 50mm。 


43 M_Out(14) =1' 一 一 卡 爪 收回 。 

44 Ovrd 5 ' 一 一 速度 倍率 5% 。 

45 Mvs phandlget ' 一 一 降 到 抓 取 位 置 。 

46 M Out(14) =0 “一 一 打开 卡 爪 。 

47 Dly 0.5 ' 一 一 暂停 0.5 秒 。 

48 Mvs phandlget+ ( + 0.00, + 0.00, -50.00, +0.00, +0.00,+0.00) 一 一 回升 到 50mm 上 方 。 
49 Hlt “一 一 暂停 

50 GoTo x getfs ' 一 一 跳 转 到 " * getfs" 行 。 
7 抓 取 工 件 1。 

52 * getfs' 一 一 程序 分 支 标志 。 

53 Ovrd 40 ' 一 一 设置 速度 倍率 。 


54 Mvs phandlget + ( + 0.00, + 0.00, - 250.00, +0.00, +0.00, +0.00) 一 一 高 速 移动 到 抓 手 上 
方 250mm 高 度 。 

55 Mov pfslget+ (+0.00, +0.00, ~ 250.00, +0.00, +0.00, +0.00) 一 一 高 速 移动 到 取 工 件 
1 上 方 250mm 高 度 。 

56 Mvs pfslget + (+0.00, +0.00, -50.00, +0.00,+0.00,+0.00) 一 一 高 速 下 降 到 工件 1 上 
方 50mm。 

57 M_0ut(10) = 0 “一 一 汽 拭 关闭 。 


58 M_Out(12) = 0' 一 一 输出 12 = 0。 

59 Ovrd 5 ' 一 一 设置 速度 倍率 。 

60 Mvs pfslget ' 一 一 低速 下 降 到 抓 取 工 件 1 位 置 。 

61 Dly 0.5' 一 一 暂停 0.5 秒 。 

62 M_Out(10) = 1 一 一 工件 1 夹 取 。 

63 M_Out(12) = 1 ' 一 一 输出 12=1。 

64 Dly 0. 5 ' 一 一 暂停 0.5 秒 。 

65 Mvs pfslget+ ( +0.00, +0.00, -50.00,+0.00,+0.00,+0.00) ' 一 一 低速 上 升 到 工件 1 上 
方 50mm。 

66 Ovrd 40' 一 一 设置 速度 倍率 。 

67 Mvs pfslget + ( +0.00, +0.00, ~ 250.00, +0.00, +0.00, +0.00) 一 一 高 速 上 升 到 工件 1 上 


方 250mm。 

68 Hlt' 暂停 。 

69 GoTo * photol' 一 一 跳 转 到 " * photol" 行 。 
Wi 1 号 工件 1 拍照 。 

71 * photol ' 一 一 程序 分 支 标志 。 

73 Mov P_20. ' 一 一 移动 到 标准 拍照 点 。 


74 HLT' 一 一 暂停 。 

75 GoTo * comm ' 一 一 跳 转 到 通信 程序 执行 拍照 。 
76 一 一 安装 工件 177 * putfsl。 

78 HIT' 一 一 暂停 。 


81 Ovrd 5 ' 一 一 设置 速度 倍率 。 

82 Mvs PACT' 一 一 PACT 是 实际 的 工件 安装 位 置 。 
83 Dly 0.5 一 一 暂停 0.5 秒 。 

END' 一 一 暂停 。 


27.3 需要 思考 的 问题 


(1) 在 案例 中 ,怎样 获得 偏差 补偿 量 ? 

(2) 如 何 编制 偏差 的 程序 ? 

(3) 阐述 解决 问题 的 工作 流程 。 

(4) 说 明 偏 差 量 计算 公式 PH=Inv(PVSo) * PVSCHK 的 几何 意义 。 
(5) 说 明 案例 2 的 解决 方案 及 操作 流程 。 
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第 28 日 
第 28 章 学 习 及 应 用 


【学 习 目 的 】 

视觉 追踪 功能 是 根据 视觉 系统 的 数据 信息 和 传送 带 的 运动 信息 驱动 机 器 人 动作 的 功 
能 ,因此 牵涉 三 个 方面 , 即 机 器 人 、 视 觉 系 统 、 传 送 带 。 在 本 章 要 学 习 视 觉 追踪 系统 的 构成 和 
机 器 人 追踪 功能 的 指令 ,对 视觉 追踪 功能 有 一 个 框架 性 的 了 解 。 


28.1 概 述 


28.1.1 追踪 功能 


追踪 功能 指 机 器 人 追踪 在 传送 带 上 的 工件 运动 的 功能 ,可 以 在 传送 带 不 停机 的 情况 下 
抓 取 及 搬运 工件 ,不 需要 工件 固定 于 某 一 位 置 。 其 特点 如 下 。 

(1) 能 够 追踪 在 传送 带 上 线性 整齐 排列 的 工件 并 抓 取 搬运 工件 (使 用 光电 开关 检测 在 
传送 带 上 的 工件 位 置 ) 。 

(2) 能 够 追踪 在 传送 带 上 不 规则 排列 的 工件 (包括 不 同 种 类 的 工件 ) 并 抓 取 搬运 工件 
(使 用 视觉 系统 检测 工件 位 置 )。 

(3) 追踪 传送 带 运 动 速度 变化 的 工件 。 

(4) 使 用 MELFA-BASIC V 编程 指令 可 以 方便 编制 追踪 程序 。 

(5) 使 用 采样 程序 可 以 方便 构建 系统 。 


28.1.2 一 般 应 用 案例 


追踪 功能 一 般 应 用 于 如 下 场合 。 

1. 食品 加 工 流水 线 

图 28-1 表示 在 食品 生产 流水 线 上 使 用 机 器 人 进行 追踪 
抓 取 摆 放 成 品 。 

2. 将 工件 整齐 排列 

图 28-2 是 将 生产 流水 线 上 随机 凌乱 排列 的 工件 摆 放 整 
齐 的 案例 。 

3. 小 型 电子 产品 的 装配 
图 28-1 在 食品 生产 流水 线 上 图 28-3 是 使 用 机 器 人 的 追踪 功能 进行 小 型 电子 产品 

使 用 机 器 人 进行 追踪 配 的 案例 。 


图 28-2 将 生产 流水 线 上 随机 排列 


的 工件 摆 放 整齐 


28-3 使 用 机 器 人 的 追踪 功能 进行 
小 型 电子 产品 装配 


28.1.3 追踪 功能 技术 术语 和 缩写 


关于 追踪 功能 的 部 分 技术 术语 及 缩写 如 表 28-1 所 示 。 
表 28-1 追踪 功能 的 部 分 名 称 及 缩写 


名 词 功 能 
追踪 功能 即 机 器 人 追踪 在 传送 带 上 的 工件 运动 ,在 传送 带 不 停机 的 情况 下 抓 取 及 搬 
追踪 功能 本 
运 工件 的 功能 

传送 带 扎 踪 ta i st 

5 当 传送 带 上 的 工件 为 不 规则 排列 时 ,机 器 人 根据 视觉 系统 提供 的 信息 进行 追踪 的 工 
视觉 追踪 作 模式 
网 络 视觉 传感器 | 用 于 识别 工件 的 视觉 传感器 系统 
编码 器 编号 由 参数 EXTENC 设置 的 编码 器 编号 。 表 示 在 追踪 功能 中 使 用 的 编码 器 序号 


TREN signal 


追踪 功能 使 能 信号 


28.1.4 可 构成 的 追踪 应 用 系统 


除了 在 28. 1. 2 节 列 举 的 追踪 功能 应 用 场合 外 ,根据 机 器 人 控制 器 的 功能 ,还 可 以 进行 
如 表 28-2 所 示 的 应 用 。 


表 28-2 可 构成 的 追踪 应 用 系统 


控制 器 CR750-D 
CR751-D 


系统 样 例 


OK 


机 器 人 抓 取 在 传送 带 上 运行 的 工件 


OK 


从 托盘 上 抓 取 工件 放置 在 传送 带 上 


OK 


将 工件 放置 在 机 器 人 上 方 的 S 形 挂钩 上 


OK 


在 追踪 过 程 中 ,机 器 人 对 传送 带 上 的 工件 进行 加 工 处 理 


OK 


在 追踪 过 程 中 ,对 传送 带 上 的 工件 进行 装配 


OK 


能 够 对 传送 带 A 和 传送 带 B 进行 追踪 


OK 


能 够 使 用 差 动 型 编码 器 进行 追踪 


walolalslwlv|- 


OK 


能 够 使 用 电压 型 编码 器 和 集 电极 开路 型 编码 器 构成 追踪 系统 
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28.2 硬件 系统 构成 


本 节 和 叙述 构成 追踪 系统 所 需要 的 最 基本 的 硬件 , 即 除 了 机 器 人 本 体外 所 需要 的 硬件 。 
28.2.1 传送 带 追 踪 用 部 件 构 成 


传送 带 追 踪 系 统 所 需要 的 硬件 如 表 28-3 所 示 。 
表 28-3 ”传送带 追踪 系统 所 需要 的 硬件 
部 件 名 称 型 号 数 量 说 明 


示 教 单元 R32TB/R33TB 


用 于 确认 抓 手 抓 牢 工件 


气 阀 输入 接口 2A-RZ365 或 2A-RZ375 


蚂 
3 
可 ~ 
bd 
ES 


推荐 使 用 编码 器 型 号 
编码 器 N OmronE6B2-CWZ1X-1000/ 一 2000 
编码 器 电缆 为 带 屏蔽 双 绞 线 


光电 开关 N 用 于 同步 追踪 系统 


a 
< 
旺 
G3 
各 


用 于 编码 器 


24V 电源 N 用 于 光电 开关 


3D-11C-WINE 
3D-12C-WINE 


RT ToolBox2 


28.2.2 视觉 追踪 系统 部 件 构 成 
视觉 追踪 系统 所 需要 的 硬件 如 表 28-4 所 示 。 
表 28-4 视觉 追踪 系统 所 需要 的 硬件 


部 件 名 称 型 号 数 量 备 注 
机 器 人 部 分 
示 教 单元 R32TB/R33TB 
抓 手 
抓 手 传感器 用 于 确认 抓 手 抓 牢 工件 


是 
ES 
机 
Dal 1 
ES 


气 阀 输入 接口 2A-RZ365 或 2A-RZ375 


续 表 


部 件 名 称 型 号 数 量 备 注 
标定 用 检 具 1 
传送 带 部 分 

推荐 使 用 编码 器 型 号 
编码 器 N OmronE6B2-CWZ1X-1000/ 一 2000 
编码 器 电缆 为 带 屏蔽 双 绞 线 
光电 开关 N 用 于 同步 追踪 系统 
5V 电源 N 用 于 编码 器 
24V 电源 N 用 于 光电 开关 
视觉 系统 
视觉 系统 4D-2CG5xxxx-PKG 1 套 
镜头 1 
照明 设备 1 
连接 部 件 
Hub 1 
. 机 器 人 控制 器 与 Hub 之 间 连 接 ; 计 
EN 算 机 与 Hub 之 间 连 接 
个 人 计算 机 
个 人 计算 机 
i 3D-11C-WINE 
3D-12C-WINE 


28.2.3 传送 带 追 踪 系 统 构成 案例 


本 节 以 图 示 方 式 说 明 追 踪 系 统 的 构成 和 布置 ,如 图 28-4 和 图 28-5 所 示 。 
机 器 人 


控制 器 


光电 开关 
编码 器 


机 器 人 动作 范围 


se 名 传送 带 运动 方向 


工件 


28-4 ”传送带 追踪 系统 的 构成 和 布置 


在 传送 带 追 踪 系 统 中 ,机 器 人 的 动作 范围 必须 覆盖 传送 带 运行 区 域 的 一 部 分 。 传 送 带 
上 的 工件 是 线性 整齐 排列 的 ( 即 在 机 器 人 坐标 系 中 ,工件 位 置 的 X 和 2 坐标 都 不 变化 ,只 有 
Y 坐标 不 断 变化 ) ,而 且 : 

(1) 使 用 简单 的 光电 开关 检测 工件 经 过 的 位 置 ,光电 开关 的 检测 信号 输入 到 机 器 人 控 
制 器 的 通用 1/O 单元 。 光 电 开关 使 用 DC24V 电源 。 

(2) 使 用 编码 器 检测 传送 带 的 运动 速度 ,也 间接 表示 了 在 传送 带 上 工件 的 运动 位 置 。 
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编码 器 信号 直接 输入 到 机 器 人 控制 器 中 。 编 码 器 使 用 DC5V 电源 。 


机 器 人 IO 
模块 
胜 


传送 带 
运动 方向 


28-5 传送带 追 踪 系 统 的 实物 构成 图 


28.2.4 视觉 追踪 系统 构成 案例 
本 节 以 图 示 方 式 说 明 视 觉 追 踪 系 统 的 构成 和 布置 ,如 图 28-6 和 图 28-7 所 示 。 
机 器 人 本 体 机 器 人 控制 器 


编码 器 


工件 移动 
‘yg 方向 


I 件 


机 器 人 党 照相 机 
移动 范围 


图 28-6 视觉 追踪 系统 的 构成 和 布置 


以 太 网 电缆 


图 28-7 视觉 追踪 系统 的 实物 构成 和 布置 


在 视觉 追踪 系统 中 ,机 器 人 的 动作 范围 必须 覆盖 传送 带 运行 区 域 的 一 部 分 。 传 送 带 上 
的 工件 是 无 规则 排列 的 ( 即 在 机 器 人 坐标 系 中 ,工件 位 置 的 X、Y、Z 坐标 都 可 能 变化 ) ,所 以 : 

(1) 使 用 视觉 系统 检测 工件 的 位 置 , 视 觉 系 统 通过 以 太 网 与 机 器 人 控制 通信 ,将 检测 识 
别 到 的 工件 位 置信 息 传送 到 机 器 人 控制 器 。 视 觉 系 统 使 用 DC24V 电源 。 

(2) 使 用 编码 器 检测 传送 带 的 运动 速度 ,也 间接 表示 了 在 传送 带 上 工件 的 运动 位 置 。 
编码 器 信号 直接 输入 到 机 器 人 控制 器 中 。 编 码 器 使 用 DC5V 电源 。 


28.3 技术 规格 


在 构成 追踪 系统 时 ,首先 会 确定 追踪 系统 中 传送 带 的 速度 和 抓 取 位 置 精度 ,这 就 是 追踪 
系统 的 部 分 技术 规格 。 
如 表 28-5 所 示 是 追踪 功能 技术 规范 。 


表 28-5 追踪 功能 技术 规范 


项 目 规 范 
RV-3SD/6SD/12SD 系列 
适用 机 器 人 RH-6SDH/12SDH/18SDH 系列 
RH-FH-D 系列 
CR1D/CR2D/CR3D 
于 用 信人 各 CR750-D/CR751-D 
机 器 人 程序 语言 配置 有 追踪 功能 的 机 器 人 语言 
300mm/s( 机 器 人 频繁 运送 工件 ) 
运动 速度 500mm/s( 工 件 间隔 较 大 ) 
一 个 机 器 人 可 服务 于 两 条 传送 带 
输出 格式 , A,A/,B,B/,Z,Z/ 
输出 规范 : 线性 驱动 
传送 带 编码 器 最 高 响应 频率 : 100kHz 

分 辩 率 : 最 高 2000 脉冲 / 转 
推荐 型 号 : Omron E6B2-CWZ1X-1000 
E6B2-CWZ1X-2000 
24AWG(0. 2mm’ ) 
电缆 长 度 : 最 长 25m。 屏 项 双 绞 线 


编码 器 电缆 


光电 开关 


视觉 系统 


位 置 精度 约 士 2mm (传送 带 速 度 为 300mm/s 时 ) 


28.4 追踪 工作 流程 


本 节 叙 述 追 踪 工 作 的 流程 ,有 些 工 作 将 在 以 下 的 章节 中 介绍 ,本 节 仅 起 到 一 个 提纲 邦 领 
的 作用 ,按照 如 图 28-8 所 示 的 工作 流程 就 不 会 发 生 紊乱 。 
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7 运行 C 程 序 
计算 被 识别 工件 置 于 
es 机 器 人 抓 取 位 置 之 间 
2 连接 设备 的 关系 
1 8 示 教 和 调节 变量 
3 设置 参数 的 设置 
1 
4 运行 采样 程序 9 自动 运行 
1 
5 运行 A 程序 
ye 
量 /脉冲 
6 运行 8 程序 ad 
标定 视 妆 在 1 
机 器 人 坐标 系 中 
的 位 置 11 排除 故障 


L | 


28-8 追踪 工作 流程 图 


(1) 工作 开始 。 

(2) 连接 设备 一 一 机 器 人 本 体 连接 安装 及 初始 化 。 

@ 机 器 人 本 体 安装 及 自 带电 缆 的 连接 ; 

@ 机 器 人 原点 设置 及 初始 化 设置 ; 

@ 机 器 人 I/O 信号 端子 排 制作 及 安装 连接 ; 

@ 机 器 人 操作 面板 的 制作 及 连接 ; 

加 编码 器 端子 头 的 制作 及 电缆 制作 连接 ; 

@ 光电 开关 安装 及 信号 连接 ; 

@ 视觉 系统 安装 以 及 以 太 网 连接 ; 

编码 器 安装 及 电缆 连接 。 

(3) 设置 参数 。 

根据 20. 6 节 的 说 明 进 行 参数 设置 ,参数 是 必 不 可 少 的 。 
(4) 进行 各 信号 的 有 效 性 检查 。 

g@ 检查 传送 带 运行 编码 器 数值 是 否 有 变化 。 

@ 检查 光电 开关 信号 是 否 有 效 。 

@ 检查 是 否 能 够 接收 到 视觉 系统 发 出 的 数据 。 

(5) 运行 A 程序 : 进行 单位 脉冲 机 器 人 移动 量 标定 。 

(6) 运行 B 程 序 : 进行 视觉 坐标 系 与 机 器 人 坐标 系 关系 的 标定 。 
(7) 运行 C 程序 : 标定 “ 抓 取 点 ”“ 待 避 点 ”“ 下 料 摆 放 点 ”。 
(8) 试 运 行 1 井 程 序 及 CMI 程序 ,调整 抓 取 点 位 置 补偿 量 。 


(9) 维护 。 
(10) 结束 。 


28.5 设备 连接 


28.5.1 编码 器 电缆 的 连接 


一 台 机 器 人 控制 器 最 多 连接 两 台 编 码 器 ,使 用 E6B-2-CWZ1X(OMRON 编码 器 ) 。 
如 图 28-9 所 示 ,编码 器 共有 8 根 信 号 线 需要 连接 。 
(1) 将 编码 器 厂家 提供 的 编码 器 电缆 连接 在 中 继 端子 排 上 ; 
(2) 通过 中 继 端子 排 与 机 器 人 厂家 提供 的 插头 相连 
(3) 将 插头 插入 机 器 人 控制 器 ; 
(4) 特别 注意 必须 将 屏蔽 线 接 地 。 


CR751-D 插 头 。 CR750-D 插 头 Cs | 5V 电 源 
二 LI 
< 子 排 
ES 端子 排 Brown(+sV) 


CH1 28| CH1CNUSR11 6 [一 xcnm sG 上 Laueeov 一 一 
33 jcNUSR12 6 + ee SG 


1 

21 jcNuSR13 3 T T LAH1 [Black 
46 CNUSR13 4 XX LAL1 Bedhedsps | 一 
22 CNUSR13 5 DD | LBH1 hi I 
47 [CNUSR13 6 六 一 一 LBL1 IET3 — 编码 器 门 
23 jcNusR13 8 TX + x LzH1 [Orange 
48 L 1 1 LZL1 [Orange/Red stipej 一 

1 1 

1 1 1 ES 

} = 5V 电 源 

CNUSR2 插 头 ”CNUSR2 插 头 ! ! . stp 
CNUSR2 connector CNUSR2 connector 1 | 1 Browntt5V)| 
CH2 15| CH2 15 CH2 SG [ewe [HH— 
40 40| 一 上 -人 一 a| se -lst 
21 21 T ry 十 LAH2 Black 
46 46| -一 XH XH LAL2 BlacWRed stripe 
DO .ts 
1 as 

sh 
48 48 9 X LzL2 [Orange/Red stipe[— / 


28-9 ”编码 器 信号 电缆 连接 图 


28.5.2 编码 器 电缆 与 控制 器 的 连接 


编码 器 电缆 最 终 必 须 连 接 到 机 器 人 控制 器 上 。 控 制 器 上 有 两 个 插口 ,不 同 的 插口 对 应 
的 “编码 器 编号 ?不 同 。 “编码 器 编号 ?是 个 重要 的 概念 ,在 后 续 的 编程 中 会 常常 提 到 ,所 以 在 
连接 时 必须 特别 注意 。 不 同 控制 器 其 编码 器 插口 位 置 不 一 样 ,请 注意 如 图 28-10 及 图 28-11 
所 示 的 位 置 。 


28.5.3 抗 干扰 措施 


在 现场 使 用 机 器 人 追踪 系统 时 ,电磁 干扰 可 能 会 对 编码 器 信号 造成 干扰 ,有 时 甚至 是 极 
大 的 干扰 ,造成 机 器 人 不 能 够 正常 地 工作 甚至 是 误 动作 ,所 以 必须 采取 基本 的 抗 干扰 措施 。 | 第 
如 图 28-12 所 示 ,至 少 必须 采取 以 下 三 项 措施 。 28 
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.ooF 
下 ”小 于 300mm 


磁 环 


编码 器 电缆 
28-10 CR750-D 控制 器 与 编码 器 电缆 连接 图 


CR751-D series 


硬 


-编码 器 电缆 


图 28-11 CR751-D 控制 器 与 编码 器 电缆 连接 图 


(1) 在 AC 电源 侧 加 装 线性 滤波 器 ; 
(2) 在 电缆 上 加 装 磁 环 ， 
(3) 必须 保证 良好 的 接地 。 接 地 线 应 该 大 于 14mm? 。 


C 电 源 
机 器 人 
本 体 
传送 带 及 编码 器 口 滤波 器 
AC/DC a 
fa 机 器 人 
| £87 电源 控制 器 
接线 洲 环 
风光 wf 区 磁 环 
二 ， 磁 环 
直流 侧 框架 地 GE 
s 编码 器 电缆 


图 28-12 抗 干 扰 措施 


28.5.4 与 光电 开关 的 连接 


光电 开关 的 信号 直接 作为 输入 信号 接 人 机 器 人 控制 器 的 通用 1/O 单元 中 。 注 意 源 型 
接 法 和 漏 型 接 法 有 所 不 同 。 

图 28-13 是 光电 开关 连接 示意 图 。 光 电 开关 一 般 使 用 DC24V 电源 。 图 28-14 是 源 型 
接 法 的 连接 图 。 


机 器 人 控制 器 
光电 开关 
通用 输入 控制 器 通用 WO pe 24V 
op 33kQ | ) 
EF 关 
ps 14(COM) 24V 面 
0 
[siIslslsIs 电流 
工件 = 
图 28-13 ”光电 开关 与 控制 器 的 连接 图 28-14 ”光电 开关 与 控制 器 源 型 接 法 示意 图 
28.6 参数 的 定义 及 设置 
本 节 解 释 有 关 追 踪 参 数 的 定义 和 设置 ,如 表 28-6 所 示 。 
表 28-6 ”追踪 参数 
参数 参 数 名 功能 说 明 出 厂 值 
追踪 功能 使 能 
追踪 模式 TRMODE 0: 不 能 1, 使 能 0 
参数 名 : TRMODE 机 可 号 : 0 
WH : tmdang permisson[0:disable 1:enable] 
1:E | 
设置 编码 器 连接 通道 编号 。 指 明 编码 
器 连接 在 控制 器 的 哪 一 个 通道 口上 
连接 通道 | 编码 器 编号 | 备注 
标准 通道 1 | 1 
标准 通道 2 | 2 
编码 器 连接 通道 编号 | EXTENC Slotl CH1 
Slotl CH2 后 续 
Slot2 CH1 扩展 用 
Slot2 CH2 
Slot3 CH1 第 
Slot3 CH2 28 
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续 表 
参 数 参 数 名 功能 说 明 出 厂 值 
工件 的 间隔 距离 。 当 工件 通过 传感器 
时 ,传感器 可 能 多 次 发 出 信号 。 机 器 人 
工件 间隔 (判断 ) 距 离 | TRCWDST 控制 器 可 能 将 一 个 工件 视 为 两 个 或 更 5 
多 工件 ,因此 设置 这 个 参数 ,使 传感器 
在 两 个 工件 之 间 不 发 信号 
者 数 名 : TROWDST 机 器 号 : 0 | 
说 明 : Work check distance for tracking[mm] 
1: 5.00 
28.7 追踪 功能 指令 及 状态 变量 
28.7.1 追踪 功能 指令 及 状态 变量 一 澳 
1. 指令 一 览 表 
如 表 28-7 所 示 为 指令 一 览 表 。 
表 28-7 指令 一 览 表 
指令 名 称 功 能 
TrBase 设置 追踪 模式 的 “追踪 起 点 ”和 “编码 器 编号 ” 
TrClr 对 “追踪 缓存 区 ” 清 零 
Trk 启动 或 结束 “追踪 模式 ”。 
TrOut 输出 信号 并 读 编码 器 数据 
TrRd 从 “追踪 缓存 区 ” 读 工件 数据 
TrWrt 向 “追踪 数据 缓存 区 ” 写 工件 数据 
2. 状态 变量 一 览 表 


如 表 28-8 所 示 为 状态 变量 一 览 表 。 


表 28-8 状态 变量 一 览 表 


变量 名 称 功 能 属性 数据 类 型 
M Enc 编码 器 数值 R/W 双 精 度 实数 
M_EncL 已 经 存储 的 编码 器 数值 R/W 双 精 度 实数 
P_EncDlt 编码 器 每 一 脉冲 机 器 人 移动 量 。 这 一 数据 由 程序 A 生成 R/W 位 置 数据 
M_Trbfct 存储 在 “追踪 数据 缓存 区 ”的 数据 数量 及 整数 
P_Cvspd 传送 带 速度 (mm，rad/s) R 位 置 数据 
M_EncMax | 编码 器 数据 最 大 值 R 双 精 度 实数 
M_EncMin “| 编码 器 数据 最 小 值 R 双 精 度 实数 
M_EncSpd ”| 编码 器 速度 (脉冲 / 秒 ) R 单 精 度 实数 

追踪 操作 状态 
M_TrkCQ “| 1: 追 踪 模 态 R 实数 
0: 非 追踪 模 态 
3. 相关 函数 功能 一 览 表 
如 表 28-9 所 示 为 相关 函数 功能 一 览 表 。 
表 28-9 相关 函数 功能 一 览 表 
函数 名 称 功 能 数据 类 型 
Poscq(< position >) 检查 指定 的 点 位 是 否 在 设置 范围 内 整数 
Tons encoder number 3 获得 当前 工件 位 置 位 置 
< position >,< encoder value >) 
TrPos(< position >) 获取 在 追踪 起 点 的 工件 位 置 位 置 


28.7.2 追踪 功能 指令 说 明 
1. TrBase 追踪 基本 指令 


1) 功能 


本 指令 用 于 设 定 “追踪 原点 "和 使 用 的 "编码 器 编号 ”。 


2) 格式 


TrBase < 原点 位 置 > [ ，< 编 码 器 编号 >] 
3) 术语 说 明 
(1) < 原点 位 置 > 一 一 追踪 运行 中 的 “追踪 的 起 点 "位置 。 


(2) < 编码 器 编号 > 一 一 使 用 的 编码 器 连接 到 控制 器 的 通道 号 。 


4) 样 例 


1 TrBase P0 一 一 以 P0 为 "追踪 原点 "。 

2 TrRd P1, M1, MKIND ' 一 一 从 追踪 缓存 区 读 出 "被 检测 到 的 数据 "。 
3 Trk 0n,P1,M1 ' 一 一 以 Pl 和 M1 为 对 象 进行 追踪 。 
4 


Mvs P2 


Zero/P0 * P2"。 


28 
这 说 明 追 踪 过 程 中 目标 位 置 一 直 在 改变 (事实 上 也 一 直 在 变化 )。 系 统 能 够 识别 的 目标 | 章 


设置 Pl 的 当前 位 置 为 Plc, 使 得 机 器 人 跟踪 工件 操作 中 的 目标 位 置 为 "Plc *P_ 
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位 置 =“Plc x*P_Zero/P0 * P2”。 


P2 是 实际 程序 中 的 抓 取 点 。 
5 HClose 1 ' 一 一 抓 手 闭合 。 

6 Trk 0ff 一 一 停止 追踪 。 

5) 解释 


本 指令 用 于 设置 “追踪 原点 ”以 及 “编码 器 编号 ”。 如 果 没 有 标 写 编码 器 编号 则 为 预 置 值 
“1”。 在 控制 器 中 设置 有 “追踪 原点 ”及 “编码 器 编号 ”的 初始 值 ,使 用 TrBase 或 Trk 指令 可 
以 改变 初始 值 。 

“追踪 原点 ”初始 值 = P_Zero， 编 码 器 编号 ?初始 值 王 1。 

2. TrClr 追踪 缓存 区 数据 清 零 指令 

1) 功能 

清除 追踪 缓存 区 中 的 数据 。 

2) 格式 

TrClr [< 缓存 区 编号 >] 

3) 术语 

< 缓存 区 序号 >: 追踪 数据 缓存 区 的 序号 。 设 置 范 围 为 1 一 4。 

4) 样 例 

1 TrClr 1 一 一 清除 1# 追 踪 缓存 区 内 的 数据 。 

2 * LO0P' 一 一 程序 分 支 标志 。 

3 If M_In(8) = 0 Then GoTo * LOOP ' 一 一 判断 语句 。 

4 ML# =M_Enc(1) ' 一 一 将 当前 编码 器 数值 代入 M1 # 。 

5 TrWrt Pl,， M1#,MK ' 一 一 写 人 数据 。 

5) 说 明 

(1) 清除 存储 在 追踪 缓存 区 内 的 数据 。 

(2) 在 追踪 程序 初始 化 时 使 用 本 指令 。 

3. Trk 追踪 功能 指令 

1) 功能 

Trk On 一 一 机 器 人 进入 追踪 模式 工作 。 

Trk Off 一 一 停止 追踪 。 

2) 格式 

Trk On[ ,< 测量 位 置 数据 >[, [< 编码 器 数值 >][, [< 追踪 原点 >][, [< 编码 器 编号 >] ] ] ] ] 

Trk Off 

3) 术语 

(1) < 测量 位 置 数据 >( 可 省 略 ) :设置 由 传感器 检测 到 的 工件 位 置 。 

(2) < 编码 器 数据 >( 可 省 略 ) :设置 当 检测 到 工件 时 编码 器 的 数值 。 

(3) < 追踪 原点 位 置 >( 可 省 略 ): 设 置 追踪 模式 中 使 用 的 原点 。 如 果 省 略 , 则 使 用 
TrBase 指令 设置 的 原点 。 其 初始 值 = PZERO。 

(4) < 编码 器 编号 >( 可 省 略 )。 


4) 样 例 


1 TrBase P0 ' 一 一 设置 P0 为 追踪 原点 。 

2 TrRd Pl1, M1, MKIND ' 一 一 读 出 "追踪 缓存 区 "数据 。 

3 Trk 0n,P1,ML 一 一 追踪 启动 。 以 位 置 数据 P1、 编 码 器 数据 M1 为 基准 进行 追踪 。 
4 Mvs P2 
5 
6 


移动 到 P2 点 。 
HClose 1 ' 一 一 抓 手 1 = ON。 
Trk Off ' 一 一 追踪 模式 结束 。 


5) 说 明 

追踪 工作 以 检测 点 的 “工件 位 置 " 和 检测 点 动作 时 的 “编码 器 数值 ”为 基础 进行 追踪 。 
4. TrOut 输出 信号 和 读 取 编码 器 数值 指令 

1) 功能 

指定 一 个 输出 信号 = 二 ON 和 读 取 编 码 器 数值 。 

2) 格式 


TrOut < 输出 信号 编号 (地 址 )>, < 存储 编码 器 1 数值 的 变量 > [ ，[< 存 储 编 码 器 2 数值 的 变量 ] 
[ ，[< 存 储 编码 器 3 数值 的 变量 >] [ ，[< 存 储 编码 器 4 数值 的 变量 >] 

[ ，[< 存 储 编码 器 5 数值 的 变量 >] [ ，[< 存 储 编 码 器 6 数值 的 变量 ] 

[ ，[< 存 储 编 码 器 7 数值 的 变量 >] [ ，[< 存 储 编 码 器 8 数值 的 变量 >] ]]]]]]] 


3) 样 例 


1 * LOOP1 “一 一 程序 分 支 标志 

2 If M_In(10) <> 1 GoTo * LOOP1 ' 一 一 检查 外 部 信号 (光电 开关 ) 是 否 动作 。 没 有 动作 就 继续 等 待 。 
(如 果 光 电 开关 = ON, 就 执行 下 一 步 。) 

3 TrOut 20, ML# ，M2# ' 一 一 指定 输出 信号 20 = ON, 同时 指定 编码 器 1 的 数据 存储 在 ML# 变量, 编 
码 器 2 的 数据 存储 在 M2# 变量 。 存 储 过 程 与 输出 信号 = ON 同步 。 

4 * LO0P2 ' 一 一 程序 分 支 标志 。 


5 If M_In(21) <> 1 GoTo * LI00P2 ' 一 一 如 果 M In(21) = 1, 则 
6 M_out(20) = 0 ' 一 -设置 X_Out(20) = 0。 
4) 说 明 


(1) 本 指令 指定 一 个 输出 信号 二 ON 和 读 取 编码 器 数值 。 

(2) 本 指令 可 以 在 输出 计算 指令 的 同时 获取 由 编码 器 测量 的 工件 位 置信 息 。 

(3) 因为 通用 输出 信号 是 可 以 保持 的 ,因此 ,在 确认 已 经 获取 视觉 系统 信息 后 ,必须 使 
用 M_Out 变量 使 通用 输出 信号 天 OFF 。 

5. TrRd 读 追 踪 数 据 指令 

1) 功能 

从 “追踪 数据 缓存 区 ”中 读 位 置 追 踪 数 据 以 及 编码 器 数据 等 。 

2) 格式 

TrRd < 位 置 数据 > [ ，< 编 码 器 数据 >] [ ，[< 工 件 类 型 数 >] [ ，[< 缓 存 区 序号 >] [，< 编 码 器 编号 >] ] ] 

] 

3) 术语 

(1) < 位 置 数据 >( 不 能 省 略 ): 设置 一 个 变量 用 于 存储 从 缓存 区 中 读 出 的 工件 位 置 。 

(2) < 编码 器 数值 >( 可 省 略 ): 设置 一 个 变量 用 于 存储 从 缓存 区 中 读 出 的 编码 器 数值 。 

(3) < 工件 类 型 数量 >( 可 省 略 ): 设置 一 个 变量 用 于 存储 从 缓存 区 中 读 出 的 工件 类 型 数 。 
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(4) < 缓存 区 序号 >( 可 省 略 ): 设置 被 读 出 数据 的 缓存 区 序号 。 如 果 设 置 为 1 则 可 省 
略 。 设 置 范围 为 1 一 4。 与 参数 TRBUF 相关 

(5) < 编码 器 编号 >( 可 省 略 ): 设置 一 个 变量 用 于 存储 从 缓存 区 中 读 出 的 编码 器 编号 。 

4) 样 例 

(1) 追踪 操作 程序 

1 TrBase P0 ' 一 一 设置 P0 为 追踪 原点 。 

2 TrRd P1,M1, MK ' 一 一 读数 据 指令 。 读 出 的 位 置 数据 存储 在 P1, 编码 器 数据 存储 在 M1, 工件 类 型 数 


量 存储 在 MK。 

3 Trk 0n,P1,M1 ' 一 一 追踪 启动 。 工 件 检测 点 = P1, 同时 编码 器 数据 为 M1。 
4 Mvs P2 ' 一 一 前 进 到 P2 点 。 

5 HClose 1 ' 一 一 抓 手 闭合 。 

6 ”Trk Off ' 一 一 追踪 操作 结束 。 


(2) 传感器 数据 接收 程序 


1 * LOOP' 一 一 程序 分 支 标志 。 

2 IfM_ In(8) = 0 Then GoTo * LOOP ' 一 一 M_In(8) 是 光电 开关 检测 信号 。 

3 ML# =M Enc(1) ' 一 一 将 当前 编码 器 数值 代入 M1# 。 

4 ”TrRd P1, M1, MK 一 一 读数 据 指令 。 读 出 的 位 置 数 据 存储 在 P1, 编码 器 数据 存储 在 吕 , 工 件 类 型 数量 

存储 在 MK。 

5) 说 明 

(1) 本 指令 读 出 由 TrWrt 指令 写 人 指定 缓存 区 的 各 数据 : 工件 位 置 、 编 码 器 数值 .工件 
类 型 数 等 。 

(2) 如 果 执 行 本 指令 时 ,在 指定 的 缓存 区 内 没有 数据 , 则 发 出 报警 。 报 警号 2540。 

6. TrWrt 写 追 踪 数 据 指令 

1) 功能 

在 追踪 操作 中 ,将 位 置 数据 、 编 码 器 数值 写 人 “追踪 数据 缓存 区 ”中 。 

2) 格式 

TrWrt < 位 置 数据 > [，< 编 码 器 数值 >] [ ，[< 工 件 类 型 数 >] [ ，[< 缓 存 区 序号 >] [ ，< 编 码 器 编号 >] ] 

] ] 

3) 术语 

(1) < 位 置 数据 >( 不 能 省 略 ): 指定 由 传感器 检测 的 位 置 数据 。 

(2) < 编码 器 数值 >( 可 省 略 ): 指 在 工件 被 检测 到 的 位 置 点 的 编码 器 数值 。 获 取 的 编码 
器 数值 存储 在 M_Enc() 状 态 变 量 中 并 通常 由 TrOut 指令 指定 。 

(3) < 工件 类 型 数量 >( 可 省 略 ): 指定 工件 类 型 数量 。 设 置 范围 为 1 一 65 535。 

(4) < 缓存 区 序号 >( 可 省 略 ): 指定 数据 缓存 区 序号 。 设 置 二 1 时 ,可 以 省 略 。 设 置 范围 
为 1 一 4。 

(5) < 编码 器 编号 >( 可 省 略 ): 设置 外 部 编码 器 编号 。 

4) 样 例 

(1) 追踪 操作 程序 


1 TrBase P0' 一 一 设置 P0 为 追踪 原点 。 


TrRd P1,M1,MKIND“' 一 一 读数 据 指令 。 
Trk 0n,P1,M1 ' 一 一 追踪 启动 。 

Mvs P2 前 进 到 P2 点 。 

HClose 1 ' 一 一 抓 手 闭合 。 

Trk 0ff “一 一 追踪 结束 。 


(2) 光电 传感器 程序 


om um 必 wh 


1 *LO0P ' 一 一 程序 分 支 标 志 。 

2 If M_In(8) = 0 Then GoTo * LOOP ' 一 一 如 果 光 电 开 关 的 输入 信号 = OFF, 就 反复 循环 等 待 。 否 则 

3 ML# =M Enc(1) ' 一 一 如 果 光电 开关 输入 信和 号 8 = ON, 就 将 此 时 的 编码 器 数据 赋予 M1# 。 

同时 将 此 点 位 的 工件 数据 P1, 编码 器 数据 碍 #1 和 工件 类 型 数 写 入 缓 


4 TrWrt Pl, MI#,MK ' 
存 区 。 


5) 说 明 

(1) 本 指令 将 测量 点 (检测 开关 二 ON) 的 工件 位 置 数据 ,编码 器 数值 .工件 类 型 数 和 编 
码 器 编号 写 人 “追踪 数据 缓存 区 ”。 

(2) 除 工件 位 置 外 的 其 他 参数 可 省 略 。 

(3) 用 参数 TRCWDST 设置 工件 间隔 距离 ,如果 工 件 在 间隔 之 内 ,就 被 视 为 同一 工件 。 
即使 数据 被 写 人 两 次 或 两 次 以 上 ,也 只 有 一 个 数据 被 存储 在 缓存 区 。 因 此 使 用 TrRd 指令 
只 会 读 出 一 个 数据 。 


28.8 故障 排除 


28.8.1 报警 号 在 9100 一 9900 的 故障 


表 28-10 为 报警 9100 一 9900 故障 一 览 表 。 
表 28-10 ”报警 9100 一 9900 故障 一 览 表 


报警 编号 故障 现象 故障 原因 及 排除 方法 

原因 : 在 C 程序 中 视觉 系统 与 机 器 人 未 正确 连接 或 机 器 人 未 能 登录 在 

9100 “| 通信 故障 视觉 系统 中 。 

处 理 : 检查 连接 机 器 人 和 视觉 系统 的 以 太 网 电缆 

原因 : 编码 器 编号 设置 超出 范围 。 

处 理 : 检查 程序 中 PE 变量 的 X 坐标 值 

原因 : 设置 的 “工件 类 型 数 "超出 范围 。 

9102 “| 工件 类 型 数 超 范围 | 处 理 : 检查 “C 程序 ”中 变量 PRMI1 的 X 坐标 值 。 

如 果 该 值 大 于 11, 则 要 修改 C 程序 中 的 程序 行 “MWKMAX=10” 

原因 : 由 A 程序 和 C 程序 计算 的 位 置 精度 与 理论 值 相差 很 大 。 

处 理 : 

(1) 检查 CM1 程序 中 的 位 置 变量 PVTR 的 X 和 YY 坐标 值 。 这 些 数 值 

9110 位 置 精度 超 范围 表示 了 与 理论 值 的 差别 。 

(2) 如 果 这 些 数值 相差 过 大 , 则 再 次 运行 “A 程序 ”“B 程序 ”“C 程序 ”。 

(3) 检查 “CMI 程序 "中 的 位 置 变量 PCHK 的 X 和 YY 坐标 值 是 否 不 为 第 

“0”。 如 果 二 0, 则 需要 修改 这 些 差 值 到 允许 的 精度 28 
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9101 “| 编码 器 编号 超 范围 


第 28 日 一 一 视觉 过 踪 功能 的 学 习 及 应 用 


30 日 学 烧 工 业 胡 器 人 


续 表 
报警 编号 故障 现象 故障 原因 及 排除 方法 
原因 : 在 1# 程 序 中 的 * S50WKPOS 程序 不 能 生成 一 个 返回 值 。 
9199 “| 程序 错误 处 理 : 检查 * S50WKPOS 程序 中 的 MY50STS 值 不 能 从 0 改变 为 其 他 
值 的 原因 


28.8.2 其 他 报警 


表 28-11 为 其 他 故障 报警 一 览 表 。 
表 28-11 其 他 故障 报警 一 览 表 


报警 号 故障 现象 故障 原因 及 排除 方法 
原因 : 编码 器 数值 不 正常 
处 理 : 

L2500 | 编码 器 数据 错误 (1) 以 固定 速度 检查 传送 带 的 旋转 状态 ; 
(2) 检查 编码 器 连接 状态 ; 
(3) 检查 地 线 及 接地 
原因 : 追踪 参数 

L2510 | 追踪 参数 错误 EXCRGMN 和 EXCRGMX 设置 值 相反 


处 理 : 检查 ENCRGMX 和 ENCRGMN 的 设置 值 

原因 : 参数 TRBUF 的 设置 值 超 范围 。 

处 理 : 检查 并 重新 设置 参数 TRBUF。 

原因 : 缓存 区 数据 写 人 错误 。 

处 理 : 

(1) 检查 TrWrt 指令 的 执行 次 数 是 否 正确 。 

(2) 检查 参数 TRBUF 的 设置 是 否 正确 。 

(3) 检查 “CM1 程序 ”中 的 位 置 变量 PCHK 的 X 和 YY 坐标 值 是 否 不 
为 0。 如 果 为 0, 则 需要 修改 这 些 差 值 到 允许 的 精度 


原因 : 没有 数据 被 写 进 缓存 区 ,所 以 读 不 出 数据 。 
处 理 : 
没有 数据 被 写 进 缓存 
L2540 区 ,所 以 读 不 出 数据 (1) 人 M_Trbfct 确认 缓存 区 内 有 数据 之 后 再 执行 TrRd 
目 日 
(2) 确认 读 指令 与 写 指令 的 缓存 区 序号 相同 
L2560 “| 追踪 参数 不 当 原因 : EXTENC 参数 设置 超出 范围 。 设 置 范围 1 一 8 
L3982 | 点 位 不 当 不 能 使 用 原因 : 奇异 点 
原因 : 在 实时 信号 输入 模式 中 , 外 部 输出 信号 810 一 817 不 能 被 
L6632 | 不 能 写 人 TREN 信号 | 写 入 。 
处 理 : 使 用 实时 输入 信号 TREN 


L2520 | 追踪 参数 超 范围 


L2530 


28.9 参数 汇总 


与 追踪 功能 相关 的 参数 如 表 28-12 所 示 。 


表 28-12 与 追踪 功能 相关 的 参数 
参数 名 称 参数 简写 功 能 出 厂 值 


追踪 缓存 区 的 编号 及 大 小 (KB) 

追踪 缓存 区 用 于 存储 追踪 工作 的 数据 。 主 
追踪 缓存 区 TRBUF 要 存储 每 一 传送 带 的 数据 。 当 增加 传送 带 | 2,64 
时 就 要 改变 设置 值 。 设 置 范围 1 一 8。 缓 存 
区 大 小 设置 范围 1 一 200KB 


基数 名 : TRBUF 机 器 号: 0 


说 明 ; Tracking data number of buffer, sze of buffer 


编码 器 数据 最 小 值 
编码 器 数据 最 小 值 | ENCRGMN | 编码 器 数值 由 状态 变量 M_Enc 0,0,0,0,0,0,0,0 
获得 


者 数 名 : ENCRGMN 机 器 号 : 0 
说 明 : Logical mn value for extemal encodor 


人 
el|e|e[=| 
四 vv ou 
ojojole 


编码 器 数据 最 大 值 
编码 器 数据 最 大 值 | ENCRGMX | 编码 器 数值 由 状态 变量 M_Enc 100000000 
获得 


参数 名 : ENCRGMX 机 器 号 : 0 
WEA : Logical max value for etemal encodor 


3 1000000000 
: 1000000000 
: 1000000000 
1000000000 


: 1000000000 
: 1000000000 
: 1000000000 
1000000000 


人 
四 No wu 


(以 传送 带 速度 100mm/s 为 基准 ) 设 置 一 个 
延迟 量 。 

例 1: 当 传 送 带 速度 二 50mm/s, 需 要 延迟 
2mm 时 ,设置 TRADJ1=4(2/50X100) 

例 2: 当 传 送 带 速度 二 50mm/s, 需 要 延迟 
一 lImm 时 ,设置 TRADJ1= 一 2( 一 2/50X100) 


追踪 调节 系数 1 TRADJ1 


1: bp.00 5: 0 

2: 0.00 6: 0.00 

3: 0.00 7: 0.00 第 
4: 0.00 8: 0.00 28 
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续 表 
参数 名 称 参数 简写 功 能 出 厂 值 


修正 传送 带 速度 为 Vc 十 TRADJ2X (Vc 一 
Vp) 

Vc 二 当前 采样 的 传送 带 速度 

Vp 二 前 一 次 采样 的 传送 带 速 度 


追踪 调节 系数 2 TRADJ2 


WIN 
2 
加 
3 


28.10 需要 思考 的 问题 


(1) 什么 是 传送 带 追 踪 ? 什么 是 视觉 追踪 ? 

(2) 传送 带 追 踪 使 用 什么 检测 器 件 ? 

(3) 编码 器 起 什么 作用 ? 

(4) TrBase 追踪 指令 主要 有 什么 用 途 ? 

(5) Trk 追踪 功能 指令 的 主要 用 途 是 什么 ? 
(6) TrWrt 写 追 踪 数 据 指令 的 主要 用 途 是 什么 ? 


第 29 章 第 29 日 一 一 视觉 追踪 程序 的 编制 


【学 习 目 的 】 

本 章 学习 追 踪 程序 的 编制 。 追 踪 程 序 不 是 一 个 单一 的 程序 。 追 踪 程 序 一 般 由 5 个 程序 
构成 。 这 5 个 程序 不 是 主 程序 与 子 程序 的 关系 ,而 是 各 自 有 独立 功能 的 程序 。A 程序 是 获 
得 机 器 人 与 传送 带 的 运动 之 间 的 关系 。B 程序 是 获得 机 器 人 与 视觉 系统 信息 之 间 的 关系 。 
C 程序 是 获得 机 器 人 抓 取 工作 点 的 数据 。CM 程序 是 实时 传递 视觉 信息 的 程序 。1 井 程序 
是 自动 运行 程序 。 在 本 章 的 学 习 中 要 深刻 体会 各 个 程序 的 功用 及 编制 方法 。 


29.1 追踪 程序 结构 


由 于 追踪 程序 不 是 一 个 单一 的 程序 ,在 运行 自动 程序 之 前 ,必须 先 运行 几 个 采样 及 标定 
程序 以 获得 必要 的 数据 。 本 节 叙 述 不 同 的 追踪 程序 中 所 包含 的 采样 程序 和 自动 程序 。 
如 表 29-1 所 示 的 是 传送 带 追 踪 程 序 结构 所 包含 的 各 采样 程序 和 自动 程序 。 
表 29-1 传送 带 追 踪 的 各 采样 程序 和 自动 程序 


程序 名 描 述 功 能 
A 采样 计算 每 一 脉冲 机 器 人 移动 量 计算 每 一 脉冲 机 器 人 移动 量 
要 人 本 程序 用 于 计算 工件 抓 取 点 坐标 值 。 该 坐标 值 
当 全 
C 工件 坐标 系 与 机 器 人 坐标 系 的 配合 程序 基于 光电 开关 的 信号 
1 自动 程序 本 程序 用 于 在 追踪 移动 中 吸 抓 工件 并 搬运 工件 
CM1 “| 写 数据 程序 本 程序 用 于 监视 编码 器 值 并 写 人 “追踪 缓存 区 ” 


29.2 视觉 追踪 程序 结构 
视觉 追踪 所 包含 的 各 采样 标定 程序 和 自动 程序 如 表 29-2 所 示 。 
表 29-2 视觉 追踪 的 各 采样 程序 和 自动 程序 


程序 如 手 还 功能 
A | 计算 每 一 脉 济 机 器 人 移动 量 计算 每 一 脉 溃 机 器 人 移动 量 
B | 视觉 坐标 系 与 机 器 人 坐标 系 的 标定 程序 | 标定 视觉 信息 坐标 与 机 器 人 坐标 系 关系 
。 本 程序 用 于 计算 抓 取 工 作 的 坐标 值 。 该 至 标 值 基 
C | 标定 “工件 抓 取 点 
1 | 自动 探 作 程序 本 程序 用 于 自动 追踪 抓 取 传送 工件 
未 程序 用 于 将 视觉 识别 信息 及 编码 需 值 写 和 追踪 
| 缓存 区 供 1# 程序 使 用 


30 日 学 烧 工业 机 器 人 


各 程序 之 间 的 关系 如 图 29-1 和 图 29-2 所 示 。 


A 程序 一 获取 单位 Be C 程 序 一 对 抓 取 位 置 点 
脉冲 机 器 人 移动 量 " 本 和 进行 标定 
获得 了 抓 取 点 
和 视觉 识别 点 
使 用 了 “单位 移动 量 " 的 位 置 坐 标 


r 


1# 子 程序 一 一 抓 取 工件 < 一 天 | CMI 程 序 一 实时 将 视觉 


及 摆 放 工件 数据 传送 到 1# 主 程序 
_ 读 取 视 觉 系统 的 信息 
读 出 缓存 区 的 存 入 缓 在 区 
信息 进行 追踪 


追踪 缓存 区 | 


29-1 各 程序 之 间 的 关系 图 1 


开始 We 
全 局 变量 及 状态 变量 


A 程 序 一 “计算 获得 "单位 
i 了 出 -一 P_ENCDLT= 状 态 变量 


获得 视觉 点 与 机 器 人 标定 点 的 
动量 。 设 置 为 全 局 变 
央视 和 2D 村 是 | 二 护 隐 加 移 芭 设置 为 全 局 变 


获得 视觉 点 与 机 器 人 标定 点 的 
C 程 序 一 获得 抓 取 点 的 位 置 | 天 一 编码 器 移动 最 。 设 会 为 全 局 变 


量 M_101#P_101 一 一 视觉 识别 
号 从 1# 程 序 启动 CM1 程 序 
| | 
CM1 一 一 视觉 信息 实时 处 理 


点 位 置 P_100 一 一 抓 取 点 位 置 
1# 程 序 一 一 全 自动 抓 取 程序 oe es 
a hae 站 迪 绿 存 | 程序 读 取 视觉 信息 数据 ， 处 
本 地 区 信息 进行 | < 追踪 缓存 区 “| < 二 一 理 后 将 信息 数据 写 入 “追踪 
四 缓存 区 ” 


END 


图 29-2 各 程序 之 间 的 关系 图 2 


29.3 A 程序 一 一 传送 带 运动 量 与 机 器 人 


A 程序 用 于 “传送 带 移动 量 ” 与 “机 器 人 移动 量 " 关 系 的 标定 。A 程序 适用 于 传送 带 追 
踪 和 视觉 追踪 。 

传送 带 的 标定 要 参考 传送 带 在 机 器 人 坐标 系 中 的 移动 方向 ,并 且 计算 “编码 器 每 一 脉冲 的 
机 器 人 移动 量 ".“ 编 码 器 每 一 脉冲 的 机 器 人 移动 量 ? 被 保存 在 机 器 人 状态 变量 P_EncDlt 中 。 

在 工作 前 ,要 监测 编码 器 的 数值 是 否 已 经 输入 控制 器 。 转 动 编码 器 并 监视 状态 变量 M 
_Enc(1) 一 M_Enc(8) ,监测 这 些 值 是 否 改变 ,如 果 没 有 改变 ,要 检查 参数 TRMODE 的 设置 
是 否 正确 。 如 果 没 有 设置 参数 TRMODE=1, 则 M_Enc(1) 的 值 不 会 改变 。 
29.3.1 示 教 单元 运行 A 程序 的 操作 流程 

A 程序 是 采样 程序 ,所 以 运行 时 可 以 用 示 教 单元 操作 ,一 步 一 步 地 运行 程序 。 也 可 以 
使 用 自动 模式 运行 程序 ,采集 数据 并 计算 。 

手动 操作 程序 运行 步骤 如 下 。 

(1) 在 机 器 人 上 加 装 一 个 标定 用 的 测 针 ( 针 尖 状 检 具 一 一 便于 对 准 工 件 标记 点 ) 。 

(2) 设置 机 器 人 控制 模式 为 “手动 ”, 设 置 TB( 示 教 单元 ) 为 “使 能 状态 ENABLE”( 在 示 
教 单元 背面 有 使 能 按钮 , 按 下 使 能 按钮 ,灯亮 后 即 为 使 能 状态 ) ,如 图 29-3 所 示 。 

操作 面板 示 教 单元 


全 
示 教 单元 背面 


按 下 使 能 按键 
灯亮 即 为 使 能 状态 


图 29-3 ”操作 模式 开关 及 手动 使 能 开关 


(3) 在 屏幕 上 出 现 < TITLE > 时 , 按 下 Exe 键 ,出 现 < MENU > 屏幕 ,如 图 29-4 所 示 。 


IMELFA CR75x-D Ver. 53 (MENU> 
IRH-3FH5515-D 


ICOPYRIGHT (C) 2011 MITSUBISHI ELEC 
WL CORPORATION ALL RIGHTS RESE =—=> ir 


图 29-4 菜单 屏幕 
(4) 在 < MENU > 屏 上 选择 “1. FILE/EDIT”, 如 图 29-5 所 示 。 


图 29-5 文件 及 编辑 屏幕 
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(5) 选择 A 程序 并 按 Exe 键 , 显 示 < PROGRAM > 屏幕 ,如 图 29-6 所 示 。 


<FILE/EDITD> 1/ 20Rem 1 <PROGRAD A 

1 07-05-30 20:21:30 485 1 ' 凑 Ver. A1 HEHE 
A 07-05-30 20:21:30 485 和 2 § rking re pet er cal ibra 
: dt 


图 29-6 <PROGRAM > 及 监视 屏幕 


(6) 按 下 Function 键 ,改变 F1 一 F4 键 的 功能 ,如 图 29-7 所 示 。 


<PROGRAM> A 
1 振 Ver A1 接 覃 樟 料 料 前 皇 扣 汪汪 笠 竺 re bat retraite 
2 tracking ne Yo calibra my }: Peare robot YE calibra 
3 # NAME ; 棋 : Ap 


4 "大 Crate/versi 2006. 04.21 AI 


图 29-7 改变 功能 键 
(7) 按 下 F1(FWD) 键 ,执行 步 进 操作 。 
以 上 是 使 用 TB 单元 的 步 进 操作 方法 ,也 可 以 在 自动 模式 下 直接 执行 “ 
操作 。 
29.3.2 设置 及 操作 


A 程序 对 应 的 现场 操作 如 图 29-8 所 示 。 


3 机器人 2 条 逢 高 -一 一 | 6. 机 器 人 2z4 高 


1. 制作 标记 工作 人 


启动 "或 “停止 ” 


工件 识别 区 


4. 标记 工件 


1 
2. 机 器 人 移动 如 
机 器 人 移动 —— 5. 机 器 人 移动 
i 


(1) 采集 编码 器 数据 | 司机 
2) 采集 机 器 人 数据 (3) 采集 编码 器 数据 
(4) 采集 机 器 人 数据 


1~6 步 表示 了 采样 程序 的 详细 步 又 
图 29-8 ”A 程序 对 应 的 现场 操作 
人 A 程序 现场 操作 步骤 如 下 。 
在 机 器 人 上 装 一 个 标定 用 的 测 针 一 一 针尖 状 检 具 便于 对 准 工件 标记 点 ,如 图 29-9 


(1) 在 RT 软件 中 ,设置 “任务 区 1” 内 的 程序 为 A 程序 。 

(2) 给 工件 贴 上 识别 标记 ; 移动 工件 进入 追踪 区 ,并 停止 传送 带 。 工 件 停止 在 “第 1 
点 ”。 可 以 使 用 的 标记 板 如 图 29-10 所 示 ( 可 使 用 其 中 一 个 标记 点 作为 “工件 标记 点 ”) 。 

(3) 测量 第 1 点 数据 一 一 选择 “手动 ”模式 ,使 用 TB 单元 ,移动 机 器 人 对 准 追 踪 区 内 第 


机 器 人 


机 器 人 工作 区 


图 29-9 第 1 标记 点 和 第 2 标记 点 


全 0' 
全 :@ .图 
全 :人 


图 29-10 可 以 在 A 程序 中 使 用 的 “标记 板 ” 


(4) 选择 “自动 ”模式 ,使 用 TB 示 教 单元 启动 A 程序 ,A 程序 自动 运行 然后 停止 在 
HLT 步 。 

(5) 选择 “手动 ”模式 ,使 机 器 人 Z 方 向 上 升 。 

(6) 启动 传送 带 使 其 带动 工件 移动 到 第 2 点 ,停止 。 

(7) 选择 “手动 ”模式 ,使 用 TB 单元 ,移动 机 器 人 对 准 追 踪 区 内 第 2 点 (注意 : 标记 工件 
移动 范围 应 该 尽 可 能 达到 最 大 值 ,这 样 可 以 减少 测量 误差 )。 在 “手动 ”期间 , 不 要 使 程序 
复位 。 

(8) 选择 “自动 ”模式 ,再 次 启动 A 程序 ,A 程序 自动 运行 然后 停止 在 END 步 。 

(9) 使 机 器 人 ZZ 方向 上 升 。 

(10) 完成 A 程序 标定 。 

在 执行 A 程序 过 程 中 ,自动 读 取 了 第 1 点 .第 2 点 的 编码 器 数据 .位 置 数据 ,并 进行 
标定 。 


29.3.3 确认 A 程序 执行 结果 


在 RT 软件 中 监视 P_EncDlt 变量 值 。 这 个 变量 显示 每 一 脉冲 机 器 人 各 坐标 移动 量 。 
例如 ,如 果 该 值 仅 显示 Y 轴 为 0. 5, 则 表示 传送 带 移动 量 为 100 脉冲 时 ,机 器 人 在 Y 轴 方 向 
移动 50mm(0. 5X100 二 50)。 
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29.3.4 多 传送 带 场合 


多 传送 带 场 合 按 上 述 方式 同样 操作 ,但 要 注意 以 下 要 点 。 

例如 ,使 用 2 传送 带 , 编 码 器 编号 一 2 。 

(1) 在 对 应 传送 带 2 的 A 程序 中 ,将 PE 变量 的 X 坐标 设置 为 2。 

(2) 在 动作 确认 操作 中 ,使 用 RT ToolBox2 软件 ,检查 变量 P_EncDlt(2) 的 数值 。 


29.3.5 A 程序 流程 图 
A 程序 流程 图 如 图 29-11 所 示 。 


超出 范围 


检查 编码 器 数量 报警 9101 


未 超 范围 


获取 编码 器 数据 
第 ! 次 


1 


获取 当前 位 置 
第 1 次 


获取 编码 器 数据 
第 2 次 
获取 当前 位 置 
第 2 次 
1 
P_ENCDLT i 
-ENCD -一 每 一 脉冲 
计算 处 理 机 器 人 移动 距离 


计算 结果 保存 在 
P_ENCDLT -_ 


1 
结束 


图 29-11 A 程序 流程 图 


29.3.6 实用 A 程序 


' 一 一 (将 编码 器 编号 设置 为 "PE" 变 量 的 X 坐 标 ) 

' 一 一 检查 设置 变量 。 

MECMAX = 8 ' 一 一 设置 编码 器 编号 最 大 值 MECMAX = 8。 

If PE.X<1 Or PE.X> MECMAX Then Error 9101' 一 一 如 果 编 码 器 编号 超 范围 ,就 报警 9101 。 
MENCNO = PE.X' 一 一 (获取 编码 器 编号 ) 将 PE.X 值 赋予 MENCNO。 


U wb 


6 “一 一 在 传送 带 上 放置 带 标记 的 工件 ,移动 工件 进入 追踪 区 。 

7 “一 一 移动 机 器 人 到 标记 工件 的 中 心 点 。 

8 MX10EC1# =M Enc(MENCNO) ' 一 一 获取 此 位 置 编码 器 数据 (第 1 点 )。 

9 ”PX10PS1 =P_Zero' 一 一 清 零 。 

10 PX10PS1=P_Fbc(1) 一 一 获取 机 器 人 当前 值 。PX10PS1 = 机 器 人 当前 值 (第 1 点)。 
11 HLT ' 一 一 暂停 。 

12 一 一 使 机 器 人 向 上 运动 。 

13 一 一 移动 机 器 人 到 第 2 点 标记 工件 中 心 位 置 。 

14 MX10EC2 间 = M_Enc(MENCNO) 一 一 获取 编码 器 值 ,第 2 次。 

15 PX10PS2 =P_Zero ' 一 一 清 零 。 

16 PX10PS2 = P_Fbc(1) ' 一 一 获取 当前 值 ,第 2 次 ; PX10PS2 = 当前 值 (第 2 次 )。 

17 一 一 使 机 器 人 向 上 运动 。 

19 GoSub * S10ENC ' 一 一 跳 转 到 进行 P_EncDlt 计算 的 子 程序 。 

20 P_EncD1lt (MENCNO) = PY10ENC ' 一 一 保存 计算 结果 。 

21 End' 一 一 主 程序 结束 。 

23 ' 打 提 提 提 提 计算 P_EncDlt 的 程序 打 提 打 提 提 

24 ' 一 一 MX10EC1: 第 1 次 编码 器 数据 

25 ' 一 一 MX10EC2: 第 2 次 编码 器 数据 

26 ' 一 一 PX10PS1: 第 1 次 位 置 数据 

27 ' 一 一 PX10PS2: 第 1 次 位 置 数 据 

28 ' 一 一 PY10ENC: 计 算 结 果 

29 x S10ENC' 一 一 P_EncDlt 计算 子 程序 。 

30 M10ED# = MX10EC2# - MX10EC1# ' 一 一 (编码 器 数据 相 减 ) 

31 If MIOED#> 800000000.0 Then MIOED# =M10ED# — 1000000000.0 

32 If MI0ED#<- 800000000.0 Then M10ED# =M10ED# + 1000000000.0 

一 一 以 上 是 对 编码 器 数据 的 处 理 。 

33 PY10ENC.X= (PX10PS2.X— PX10PS1.X)/M10ED# 

34 PY10ENC.Y= (PX10PS2.Y— PX10PS1.Y)/M10ED# 

35 PY10ENC.Z = (PX10PS2.Z— PX10PS1.2Z)/M10ED# 

36 PY10ENC.A= (PX10PS2.A— PX10PS1.A)/M10ED# 

37 PY10ENC.B= (PX10PS2.B— PX10PS1.B)/M10ED# 

38 PY10ENC.C= (PX10PS2.C— PX10PS1.C)/M10ED# 

39 PY10ENC.L1 = (PX10PS2.L1 - PX10PS1.L1)/M10ED# 

40 PY10ENC.L2 = (PX10PS2.L2 - PX10PS1.L2)/M10ED# 

一 一 以 上 是 计算 "一 个 编码 器 脉冲 对 应 的 机 器 人 移动 量 "的 过 程 。 各 坐标 值 相 减 的 结果 除 以 编码 器 
数据 。 

41 Return' 一 一 子 程序 结束 。 

43 ' 以 下 是 A 程序 运行 前 必须 预 设置 的 变量 。 

PE= (1.000,0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 

PE.X 是 编码 器 编号 ,是 预先 设置 的 位 置 变量 形式 。 

PX10PS1 = (0.000, 0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0)( 第 1 位 置 数据 ) 
PX10PS2 = (0.000,0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) (第 2 位 置 数据 ) 
PY10ENC = (0. 000,0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0)(" 一 个 编码 器 脉冲 对 应 的 
机 器 人 移动 量 ") 


从 以 上 A 程序 可 知 ,在 机 器 人 工作 区 域内 取 两 个 工作 点 (一 般 应 该 涵盖 机 器 人 工作 区 


最 大 区 域 ) ,分别 获取 这 两 点 的 编码 器 数值 和 位 置 点 数据 。 通 过 计算 获得 “机 器 人 移动 量 / 每 
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29.4 B 程序 一 一 视觉 坐标 与 机 器 人 坐标 
本 节 介 绍 使 用 B 程序 进行 的 标定 。B 程序 用 于 视觉 系统 与 机 器 人 坐标 系 的 标定 。 


29.4.1 示 教 单元 的 操作 
(1) 使 用 T/B 打开 B 程 序 。 
(2) 设置 控制 模式 为 “手动 ”, 设 置 TB 为 使 能 状态 ENABLE, 如 图 29-12 所 示 。 
操作 面板 示 教 单元 


~ 


示 教 单元 背面 


按 下 使 能 按 
灯亮 即 为 使 能 状态 


图 29-12 操作 模式 开关 和 手动 使 能 开关 


(3) 在 屏幕 上 出 现 < TITLE > 时 , 按 下 Exe 键 ,出 现 < MENU > 屏幕 ,如 图 29-13 所 示 。 


IMELFA CR75x-D Ver. 53 (MENU> 

IRH-3FH5515-D 

ICOPYRIGHT (C) 2011 MITSUBISHI ELEC ==> : 加 AM 中 Ra err 
Wm CORPORATION ALL RIGHTS RESE IT i 


图 29-13 菜单 屏幕 


(4) 选择 “1. FILE/EDIT”, 如 图 29-14 所 示 。 


图 29-14 文件 及 编辑 屏幕 


(5) 选择 B 程序 并 按 Exe 键 ,显示 < PROGRAM > 屏幕 ,如 图 29-15 所 示 。 


KPROGRAW> B 


1 拓 Ver AT 拉 半 村 和 盾 本 江 
2 '# tracking robot - conveyor calibra 
3 " 基 NAME : B. 


.pre 
4 '# Create/version : 2006.04.21 Al 


图 29-15 <PROGRAM > 屏幕 


(6) 按 下 Function 键 ,改变 功能 显示 ,如 图 29-16 所 示 。 
(7) 按 下 F1(FWD) 键 ,执行 步 进 操作 。 


PROGRAD B PROGRAD B 


了 1 震 Ver A1 

2 '# tracking robot - conveyor calibra = 2 '# tracking robot - conveyor cal ibra 
3 '# NAME : B.prg 3 °# NAME PrE 

4 '# Create/version : 2006.04.21 Al 4 9 


29-16 改变 操作 键 功 能 


29.4.2 现场 操作 流程 
根据 图 29-17 一 图 29-19 所 示 ,进行 的 操作 如 下 。 
机 器 人 位 置 


工件 识别 区 5. 机 器 人 Z 轴 天 起 
申 中 
图 。 图 | 制 F 标 记 工作 pe 
== 
3. 标记 工件 移动 | 
2. 视觉 设置 
(1) 采集 编码 器 数据 CO) 采集 各 点 编码 器 数据 
图 29-17 B 程序 操作 图 示 
全 ©'@ 
'@:@:@® 
A A ) 
图 29-18 B 程 序 使 用 的 标定 板 
机 器 人 运动 区 
标记 工件 
2 
传送 带 运 
感 。| 咏 动向 


觉 照相 机 标记 工件 
29-19 B 程 序 工作 示意 图 


击 忆 当 
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(1) 在 机 器 人 上 加 装 测 针 。 

(2) 制作 标记 板 如 图 29-18 所 示 。 

(3) 在 RT 软件 中 ,设置 “任务 区 1” 中 为 “B 程序 ”。 

(4) 检查 与 视觉 系统 的 通信 状态 ,保证 通信 和 正常。 启动 视觉 系统 。 

(5) 启动 传送 带 。 

(6) 选择 机 器 人 “自动 工作 ”模式 。 

(7) 启动 B 程 序 ( 可 使 用 TB 单元 )。 

(8) 放置 “标记 板 ” 在 传送 带 上 使 “标记 板 ” 通 过 视觉 区 一 直 运 行 到 “机 器 人 工作 区 ”, 在 
“机 器 人 工作 区 ”中 部 使 传送 带 停止 。 

(9) 由 视觉 系统 获得 标记 板 4 个 以 上 点 位 数据 (如 1、3、5、7、9 点 位 )。 

(10) B 程序 停止 在 HLT 步 。 

(11) 选择 “手动 模式 ”。 

(12) 通过 示 教 获得 4 个 以 上 的 点 位 数据 (例如 1、3、5、7、9 点 位 ), 全 部 记录 在 RT 软件 
的 2D 标定 界面 ,如 图 29-20 所 示 。 

(13) 机 器 人 Z 轴 上 升 。 

(14) 选择 “自动 模式 ”, 启 动 B 程序 直 到 执行 到 END 步 。 

(15) 在 RT 软件 的 2D- 标 定 界 面 写 人 视觉 系统 检测 获得 的 数据 ,进行 标定 并 写 入 机 
器 人 。 

B 程序 执行 完毕 。 


29.4.3 操作 确认 


(1) 使 用 RT 软件 检查 变量 M_100()。 在 RT 软件 的 “程序 监视 ”画面 ,通过 “变量 监 
视 ” 功 能 ,也 可 以 监视 M_100() 的 数值 。M_100() 为 编码 器 数据 差 。 

(2) 确认 在 视觉 传感器 侧 获 得 的 编码 器 数据 与 机 器 人 侧 获得 的 编码 器 数据 之 差 已 经 设 
置 在 M_1000O。 


29.4.4 实用 BB 程序 


一 一 将 "编码 器 编号 "设置 为 变量 PE 的 X 坐标。 
一 一 检查 设 定 值 。 
MECMAX = 8 ' 一 一 设置 编码 器 编号 的 最 大 值 。 
If PE.X<1 Or PE.X>MECMAX Then Error 9101 一 一 如 果 编 码 器 编号 超出 允许 范围 , 则 报警 , 否则 
行 下 一 步 。 
MENCNO = PE.X ' 一 一 取得 编码 器 编号 。 
一 一 在 视觉 传感器 识别 区 域 放置 标定 板 。 
一 一 观察 视觉 画面 ,确认 标定 板 位 置 是 否 正确 。 
一 一 视觉 系统 照相 , 由 视觉 系统 记录 5 个 点 的 数据 (视觉 数据 ) 。 
ME1# =M_Enc(MENCNO) 一 一 取得 编码 器 数据 (第 1 次 )。 
10 Ht' 一 一 暂停 。 
11 一 一 将 标定 板 由 传送 带 移动 至 机 器 人 动作 范围 内 。 
12 一 一 将 机 器 人 抓 手 移动 至 标记 点 1 的 中 心 处 , 获取 机 器 人 坐标 。 
13 一 一 (8) 重 复 作业 ,获取 5 个 点 机 器 人 位 置 。 
14 一 一 (10) 上 升 机 器 人 手臂 。 


cocoa 人 ODPr 


15 ME2# =M_Enc(MENCNO) ' 一 一 取得 编码 器 数据 (第 2 次 ) 。 

16 ”MED# =ME1# - ME2# 一 一 计算 两 个 位 置 的 编码 器 数值 差 。 

17 If MED#> 800000000.0 井 Then MED# =MED# 一 1000000000.0# 

18 If MED#<-800000000.0# Then MED 井 =MED# +1000000000.0# 

19 M 100# (MENCNO) = MED# 

20 一 一 以 上 是 对 编码 器 数据 的 处 理 。 

21 Ht' 一 一 暂停 。 

22 End' 一 一 主 程序 结束 。 

23 一 一 以 下 是 运行 前 必须 预 置 的 变量 。 

PE= (+1.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 


B 程序 执行 完毕 后 获得 两 点 之 间 的 “编码 器 移动 量 MED 并 ”, 设 置 为 全 局 变量 M_100#。 
29.4.5 2D 标定 操作 


操作 步骤 如 下 。 
(1) 打开 RT 软件 , 单 击 “ 维 护 ”>2D, 弹 出 如 图 29-20 所 示 界 面 。 


机 器 人 实际 坐标 


视觉 系统 识别 到 的 坐标 
由 操作 者 填写 到 此 框 内 


移动 机 器 人 选择 校 
准点 并 获得 坐标 


单 击 此 按钮 
获取 机 器 人 
实际 位 置 


29-20 ”RT 软件 的 2D 标定 界面 


(2) 每 示 教 一 点 就 按 “ 获 取 机 器 人 数据 ” 键 ,该 示 教 点 数据 自动 进入 “机 器 人 坐标 ” 框 。 
一 共 获 取 5 点 数据 。 

(3) 将 视觉 系统 获得 的 对 应 5 点 数据 写 人 “视觉 坐标 ” 框 。 

(4) 按 "数据 计算 标定 ” 键 ,数据 进行 标定 转换 。 

(5) 按 “ 写 人 机 器 人 ” 键 。 

(6) 操作 完成 。 


29.5 C 程 序 一 一 抓 取 点 标定 


本 节 介 绍 由 C 程序 执行 的 任务 。 在 传送 带 追 踪 和 视觉 追踪 都 需要 执行 C 程序 ,只 是 各 


自 的 执行 方法 有 所 不 同 。 第 
29 
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29.S.1 用 


于 传送 带 追 踪 的 程序 


在 用 于 传送 带 追 踪 的 C 程序 中 , 既 获 取 了 光电 开关 检测 点 的 编码 器 数据 ,也 获取 了 机 
器 人 抓 取 工件 点 的 数据 ,因此 在 光电 开关 检测 动作 时 ,机 器 人 能 够 识别 工件 坐标 。 
1. 示 教 单元 运行 C 程序 的 操作 流程 


(1) 设置 控制 模式 为 “手动 ”, 设 置 TB 为 使 能 状态 操作 面板 示 教 单元 
ENABLE ,操作 如 图 29-21 所 示 。 
“ 待 避 点 “下 料 摆 放 点 ”。 示 教 单元 背面 
(3) 当选 择 * 自 动 模式 "时 ,可 使 用 示 教 单元 执行 “ 启 有 
动 ”, 停 止 操作 。 灯亮 即 为 使 能 状态 
2. C 程序 操作 流程 29-21 模式 开关 及 使 能 开关 操作 
图 29-22 是 C 程序 操作 图 示 。 
工作 识 别 区 ! 3. 移动 机 器 人 
， | 1 置 放 工件 | \ 
机 c= | | 、 
re 2) 采集 编码 器 
(1) 采集 编码 器 数据 2 传送带 及 工件 运动 本 G) 采 集 当前 人 
图 29-22 “C 程序 操作 图 示 
C 程序 操作 流程 如 下 。 
(1) 在 机 器 人 上 加 装 测 针 ( 与 A 程序 相同 ) 。 
(2) 选择 一 工件 ,在 工件 上 做 出 标记 。 
(3) 在 RT 软件 中 ,设置 “任务 区 1? 中 为 “C 程序 ”。 


(4) 启动 传 
(5) 选择 机 
(6) 启动 C 
(7) 启动 传 
(8) 选择 “ 寻 


送 带 ; 移动 工件 到 “光电 开关 ”处 ,停止 传送 带 。 

器 人 “自动 工作 ”模式 。 

程序 (可 使 用 TB 单元) ,一 直 运 行 C 程序 到 HLT 暂停 步 。 
送 带 ,在 “机 器 人 工作 区 ”中 部 使 传送 带 停止 。 


(9) 使 用 机 
(10) 选择 “ 


F 动 模式 "。 
器 人 示 教 功能 ,标定 机 器 人 抓 取 点 PGT。 
自动 模式 ”, 启 动 C 程序 直到 执行 到 END 步 。 


(11) 标定 出 “ 待 避 点 P1”“ 下 料 摆 放 点 PPT”。 

(12) C 程序 执行 完毕 。 

3. 动作 确认 

使 用 RT 软件 监视 确认 变量 M_101(0) ,P_100C0) 和 了 _102() 的 数值 。 


(1) M_101 
(2) P_100( 


: 在 “光电 开关 动作 点 ”与 “机 器 人 抓 取 点 ”编码 器 数据 之 间 的 差 值 。 
) : 工件 被 抓 取 点 的 位 置 。 


(3) P_102(0) : 在 STEP1 中 设置 的 PRMI1 数值 。 


必须 检查 以 上 各 值 是 否 正 确 。 


4. 实用 C 程序 
1) 流程 图 


C 程序 流程 图 如 图 29-23 所 示 。 


2) C 程序 


一 一 以 变量 PRM1 的 X 坐 标 值 表示 工件 类 型 数量 。 
一 一 以 变量 PRM1 的 Y 坐 标 值 表示 编码 器 编号 。 
一 一 以 变量 PRM1 的 z 坐标 值 表示 传感器 数量 。 
' 一 一 检查 设置 在 PRM1 中 的 数据 。 
MWKMAX = 10 ' 一 一 设置 工件 类 型 数 最 大 = 10。 
MECMAX = 8 ' 一 一 设置 编码 器 编号 最 大 = 8。 
MWKNO = PRM1.X ' 一 一 获取 工件 类 型 数量 。 
MENCNO = PRM1.Y' 一 一 获取 编码 器 编号 数量 。 
If MWKNO< 1 Or MWKNO > MWKMAX Then Error 9102 


bowaoueewmnbP 


和 可 工作 类 型 数 生 
六 
检查 编码 器 编写 
未 超 范 转 


10 次 循环 
清除 总 的 变量 数据 


一 一 


获取 编码 器 数据 
第 1 次 


1 


获取 工件 吸附 位 置 


1 


获取 编码 器 数据 
第 2 次 


1 


在 总 变量 中 保存 获取 的 
数据 


报警 9103 


报警 9102 


29-23 C 程序 流程 图 


一 一 如 果 工 件 类 型 数量 超 范围 就 报警 9102 
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10 If MENCNO < 1 Or MENCNO > MECMAX Then Error 9101' 一 -如果 编码 器 编号 数 超 范围 就 报警 9101 。 
11 For M1 = 1 T0 10 一 一 做 一 循环 ,对 相关 变量 清 零 。 

12 P_100(M1) =P_Zero' 对 存储 工件 位 置 的 变量 置 零 。 

13 P_102(M1) =P_Zero' 一 一 对 存储 操作 条 件 的 变量 置 零 。 

14 M_101# (ML) = 0 ' 一 一 对 存储 编码 器 数值 差 的 变量 置 零 。 

15 Next M1 ' 一 一 下 一 循环 。 

16 一 一 将 工件 移动 到 光电 开关 位 置 。 

17 ME1# =M_Enc(MENCNO) ' 一 一 获取 编码 器 数据 (第 1 次 )。 


18 HUT' 一 一 暂停 。 
19 一 一 移动 传送 带 上 的 工件 到 机 器 人 工作 区 。 
移动 机 器 人 到 抓 取 点 位 置 。 


20 ME2# =M_Enc(MENCNO) 一 一 获取 编码 器 数值 (第 2 次 )。 

21 P_100(MWKNO) =P_Fbc(1) ' 一 一 获取 工件 抓 取 点 数据 (当前 位 置 ) 。 

22 ' 一 一 执行 步 进 操作 直到 结束 。 

23 MED# = ME2# - ME1# ' 一 一 计算 两 次 编码 器 的 差 值 。MED# = 两 次 编码 器 数据 的 差 值 。 
24 If MED# > 800000000.0 Then MED# = MED# - 1000000000.0 

25 If MED# < -800000000.0 Then MED# = MED# +1000000000.0 

26 ' 一 一 以 上 是 对 编码 器 数值 的 处 理 。 

27 M_101# (MWKNO) = MED# ' 一 一 将 编码 器 的 数值 差 MED# 保存 在 一 个 全 局 变量 M_101# 中 。 
28 P_102(MWKNO) .X= PRM1.Y ' 一 一 保存 编码 器 编号 数 在 一 个 全 局 变量 中 。 

29 P_102(MWKNO) .Y= PRM1.Z ' 一 一 保存 传感器 数量 在 一 个 全 局 变量 中 。 

30 End' 一 一 程序 结束 。 


29.5.2 用 于 视觉 追踪 的 C 程序 


视觉 追踪 C 程序 获取 由 视觉 传感器 识别 的 工件 位 置 点 的 编码 器 数据 以 及 机 器 人 抓 取 
工件 点 的 数据 ,这 样机 器 人 就 能 够 识别 由 视觉 系统 获取 的 工件 坐标 。 下 面 解 释 工作 流程 和 
相关 工作 内 容 术 语 。 

1. 示 教 单元 手动 操作 

(1) 设置 控制 模式 为 “手动 ” ,设置 TB 为 使 能 状态 ENABLE, 如 图 29-24 所 示 。 


操作 面板 示 教 单元 (2) 在 手动 模式 下 ,进行 示 教 操 作 , 运 动 到 “ 抓 取 
点 ”“ 待 避 点 “下 料 摆 放 点 ”。 
~ Ew (3) 当选 择 “ 自 动 模式 ”时 ,可 使 用 示 教 单元 执行 
示 教 单元 间 面 。 “启动 “停止 操作 。 
按 下 使 能 控 竺 2. 执行 C 程序 操作 的 流程 
灯亮 即 为 使 能 状态 (1) 操作 流程 ,如 图 29-25 和 图 29-26 所 示 。 


图 29-24 模式 开关 及 使 能 开关 操作 @ 在 机 器 人 上 加 装 测 针 (与 A 程序 相同 ) 。 
@ 制作 标记 工件 ,选择 一 个 工件 ,在 工件 上 做 出 标记 。 

@ 在 RT 软件 中 ,设置 “任务 区 1” 中 为 “C 程序 ”。 

@ 检查 与 视觉 系统 的 通信 状态 ,保证 通信 和 正常。 启动 视觉 系统 。 

@ 启动 传送 带 (如 果 是 “ 面 成 像 照 相 视 觉 系 统 ”, 可 以 在 静态 下 拍照 , 则 不 需要 启动 传送 
带 。 如 果 是 “ 线 扫描 成 像 系统 ”, 则 需要 启动 传送 带 )。 

@ 选择 机 器 人 “自动 工作 ?模式 。 

@ 启动 C 程序 (可 使 用 TB 单元 ) 。 


.+ 


视觉 照相 区 


机 器 人 
29-25 “C 程序 执行 示意 图 


本 机 器 人 位 置 
人 匈 杀 统 1A 三 5. 机 器 人 Z 轴 升 高 


视觉 识别 点 一 -一 -| 


P_l0l 1. 放 置 目标 工作 4. 移动 机 器 人 人 
~ 到 此 位 置 、 
] 


抓 取 点 


P_100 
2. 视觉 系统 识别 工作 3. 移动 工作 1 
(1) 采集 编码 器 数据 (3) 采集 编码 器 数据 
(2) 采集 工件 位 置 数据 (4) 采集 机 器 人 当前 位 置 数 据 


编码 器 移动 量 : M_101# 
29-26 C 程序 执行 参考 图 


如 果 是 “ 面 成 像 照 相 视觉 系统 ”, 可 以 在 静态 下 拍照 , 则 放置 “标记 工件 在 照相 区 。 
视觉 系统 拍照 完毕 ,发 出 信号 给 机 器 人 ,机 器 人 获取 相关 信息 。 在 RT 软件 上 可 监视 编码 器 
变量 值 (启动 传送 带 , 将 工件 移动 进入 追踪 区 )。 

@ 如 果 是 “ 线 扫描 成 像 视觉 系统 ”, 则 必须 在 动态 下 拍照 ,所 以 必须 把 标记 工件 放置 在 
传送 带 上 ,使 “标记 工件 ”通过 视觉 区 一 直 运行 到 “追踪 区 ”。 

@ 在 “追踪 区 ?中 部 使 传送 带 停止 。 

@@ C 程序 停止 在 HLT 步 。 

@ 选择 “手动 模式 "。 

@@ 使 用 机 器 人 示 教 功能 ,标定 机 器 人 抓 取 点 PGT。 

@ 选择 “自动 模式 ”, 启 动 C 程序 直到 执行 到 END 步 。 

图 标定 出 “ 待 避 点 P1”,“ 下 料 摆 放 点 PPT”。 

四 C 程序 执行 完毕 。 

(2) C 程序 执行 完成 后 获得 的 全 局 变量 如 下 。 


编码 器 移动 量 : M_101#。 第 
@ 视觉 识别 点 : P_101。 29 
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@ 工件 抓 取 点 : P_100。 

这 些 变 量 可 以 在 RT 软件 中 监视 。 

3. 操作 后 的 检查 确认 

使 用 RT 软件 检查 下 列 变量 (根据 工件 类 型 数 分 别 标注 ) 。 

(1) M_101() 一 一 编码 器 数据 差 。 

(2) P_102() 一 一 变量 PRMI1 中 的 数据 (工件 类 型 数 /编码 器 编号 ) 。 
(3) P_103(0) 一 一 变量 PRM2 中 的 数据 (图 像 识 别 区 大 小 /工件 尺寸 ) 。 
(4) C_100 $ () 一 一 通信 口 序号 。 

(5) C_101 $ () 一 一 视觉 程序 名 称 。 

(6) C_102 $ () 一 一 识别 工件 数量 。 

(7) C_103 $ () 一 一 识别 信息 启动 单元 格 。 

(8) C_104 $ () 一 一 识别 信息 结束 单元 格 。 

4. 实用 C 程序 

1 一 一 将 "工件 类 型 数量 "设置 为 变量 PRM1 的 X 坐 标 。 

2 一 一 将 "编码 器 编号 "设置 为 变量 PRM1 的 了 坐标 。 

3 ”一 一 观察 视觉 传感器 的 实时 画面 ,将 移动 方向 的 视界 长 度 设置 为 变量 PRM2 的 x 坐标 。 
4 ”一 一 将 工件 的 长 度 设置 为 变量 PRM2 的 了 坐标 值 。 

5 ”一 一 打开 端口 将 CoM 的 端口 号 输入 至 下 行 中 "ccoM$ = "处 。 

6 ”CCOM$ ="COM3:”' 一 一 设 定 通信 端口 号 。 

7 一 一 将 视觉 程序 名 称 输入 至 下 行 中 "CPRG$ = "处 。 

8 ”CPRG$ ="TRK.J0B"” 一 一 设 定 视觉 程序 名 。 

9 ”一 一 将 工件 放置 在 视觉 传感器 可 以 识别 的 位 置 。 

10 一 一 将 视觉 传感器 设置 为 "在 线 "。 

10 一 一 自动 运行 C 程 序 ,程序 停止 的 话 ,使 用 T/B 再 启动 C1 程序 。 


12 MWKNO = PRM1.X”' 一 一 获取 工件 类 型 数量 。 

13 MENCNO = PRM1.Y “一 一 获取 编码 器 编号 。 

14 ' 一 一 与 视觉 传感器 端口 连接 。 

15 NVClose ' 一 一 关闭 端口 。 

16 NVOpen CCOMS As #1 ' 一 一 开启 端口 指令 。 

17 Wait M_NvOpen(1) = 1 一 一 等 待 端口 打开 。 

18 NVLoad #1，CPRG$ ”一 一 加 载 视觉 程序 。 

19 NVTrg # 1, 5,MTR1 # ,MTR2# ”' 一 一 摄像 要 求 + 获取 编码 器 值 。 


20 EBRead # 1,"",MNUM, PVS1, PVS2, PVS3, PVS4 ' 一 一 分 别 获取 各 个 识别 工件 的 数据 。 
21 open "COM2:" as #1" 打开 通信 端口 2。 

22 wait m_open(1) =1' 一 一 等 待 通信 端口 打开 。 

23 print # 1, "SE0"' 一 一 输出 字符 串 "SEo" 。 

24 input # 1, mtl,mxl,myl,mcl' 一 一 读 取 数 据 。 

25 pvs0.x= mxl' 一 一 赋值 。 

26 pvs0.y= myl ' 一 一 赋值 。 

27 'pvs0.c= mcl ' 一 一 赋值 。 

28 ”PVS0 = PVS1 ' 一 一 赋值 。 

29 PVS1= PVSCal(1,PVS0.X,PVS0.Y,PVS0.C)， 标定 指令 。 

30 P_101(MWKNO) = PVS1 ' 一 一 获取 "识别 位 置 "工件 的 数据 (将 视觉 系统 识别 的 数据 设置 为 一 个 全 局 


件 。 
29. 


29. 


变量 ) 。 
31 ”ME1# =M_Enc(MENCNO) ' 一 一 获取 编码 器 数据 1。 
32 ”NVClose #1; ' 一 一 (以 上 程序 读 出 了 视觉 系统 的 信息 并 进行 了 标定 。 也 读 出 了 编码 器 的 数值 .) 
33 Ht' 暂停 。 
34 ' 一 一 移动 传送 带 将 工件 移动 至 机 器 人 动作 范围 内 (将 工件 所 在 位 置 定 为 抓 取 点 ) 。 
35 “一 一 将 机 器 人 移动 至 " 抓 取 点 "。 
36 ME2# = M_Enc(MENCNO) ' 一 一 获取 编码 器 数据 2。 
37 P_100(MWKNO) = P_Fbc(1) ' 一 一 获取 机 器 人 抓 取 点 位 置 。 
38 一 一 执行 程序 直至 END。 
39 MED 间 =ME2# -ME1# ”' 一 一 计算 编码 器 的 移动 量 。 
40 If MED#> 800000000.0 井 Then MED 井 =MED 并 -1000000000.0# 
41 If MED#< 一 800000000.0 井 Then MED 井 = MED# +1000000000.0# 


42  M_101 间 (MWKNO) = MED# 一 一 编码 器 移动 量 ( 设 置 为 全 局 变量 ) 。 

43 P_102(MWKNO) = PRM1 “一 一 编码 器 编号 (设置 为 全 局 变量 ) 。 

44 P_103(MWKNO) = PRM2 “一 一 视觉 界面 尺寸 与 工件 尺寸 (设置 为 全 局 变量 ) 。 
45 ”C_100$ (MWKNO) = CCOMS “一 一 COM 编号 。 

46 C_101$ (MWKNO) = CPRG $ 一 一 视觉 传感器 程序 名 。 

47 Hlt' 一 一 暂停 。 


48 End' 一 一 主 程序 结束 。 

49 ' 一 一 (同时 设置 " 待 避 点 - 原点 Bl1" 和 "下 料 摆 放 点 PPT") 

50 ' 一 一 本 程序 为 获得 视觉 传感器 识别 的 工件 位 置 与 机 器 人 抓 取 位 置 的 关系 。 

51 “一 一 运行 前 必须 设置 的 变量 。 

PRM1 = ( +1.000, +1.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 


29.6 工 # 程序 一 一 自动 运行 程序 


本 节 解 释 运 行 1# 程序 的 操作 流程 。 
1# 程 序 在 传送 带 追 踪 和 视觉 追踪 中 都 是 必要 的 。1# 程 序 指令 机 器 人 追踪 并 抓 取 工 
工件 的 位 置 或 是 由 光电 开关 识别 或 是 由 视觉 系统 识别 。 


6.1 示 教 


对 “原点 ”和 “下 料 摆 放 点 ”的 示 教 操作 流程 如 下 。 

(1) 用 示 教 单元 TB 打开 1 号 程序 。 

(2) 打开 “位 置 数据 编辑 "屏幕 。 

(3) 当 系 统 启动 后 ,设置 Pl1 为 原点 。 

(4) 移动 机 器 人 到 原点 位 置 并 获取 该 位 置 , 将 其 设置 为 P1。 

(5) 设置 PPT 为 下 料 摆 放 点 位 置 ( 该 位 置 是 工件 最 终 被 放置 的 位 置 ) 。 
(6) 移动 机 器 人 到 搬运 终点 位 置 并 获取 该 位 置 数据 设置 为 PPT。 


6.2 设置 调节 变量 
1. 变量 的 定义 及 设置 2 
本 节 解 释 在 1# 程序 中 的 变量 以 及 如 何 设置 调节 变量 ,有 关 的 变量 如 表 29-3 所 示 。 章 
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表 29-3 变量 及 设置 


变量 名 称 解释 设置 样 例 
设置 “工件 类 型 数量 ”, 即 在 一 个 追踪 项 目 中 ,有 | 如 果 设 置 工件 类 型 数量 一 
PE 几 种 类 型 的 工件 pa 
“工件 类 型 数量 ” EE mp (X, Y, 2Z, A, B, C) =(+1, 
六 一 工作 类型 禾 要 (14403 十 0, 十 0, 十 0, 十 0, 十 0) 
1# 程 序 和 CM1 程序 可 以 被 同时 执行 ,1# 程 序 
控制 机 器 人 运动 ,CM1 程序 获取 传感器 或 视觉 识 | ，,，、 本 
别 数据 。PRI 用 于 指定 程序 的 执行 优先 顺序 ,并 ier ed eg 
PRI 不 是 在 同一 时 间 执行 同一 数量 的 程序 ,而 是 交替 i 
执行 。 Y, Z2, A, B, C) = (十 1， 
X 二 1# 程 序 执行 的 行 数 (1~31) 十 10, 十 0, 十 0, 十 0, 十 0) 
Y= 二 CM1 程序 执行 的 行 数 (1 一 31) 
maa ee es 
PUP1 X 一 机 器 人 “等 待 点 "高 度 Cmm) nn 
工作 高 度 ( 抓 取 工 件 过 | Y= 抓 取 点 的 “ 近 点 "高 度 (在 抓 取 之 前 ) 人 
程 ) Z= 抓 取 点 的 “ 近 点 "高度 ( 在 抓 取 之 后 ) l 


由 于 Y 和 Z 表 示 的 是 在 TOOL 坐标 系 中 Z 轴 的 
位 置 ,所 以 这 些 信 号 变量 取决 于 机 器 人 模式 。 


(X, Y, Z, A, B, C) = (十 50， 
一 50, 一 50, 十 0, 十 0, 十 0) 


PUP2 一 一 工作 高 度 


在 放置 工件 的 操作 中 ,设置 机 器 人 工作 高 度 。 高 
度 是 指 释放 工件 的 高 度 (mm) 。 
Y= 工件 释放 位 置 的 高 度 ( 在 释放 之 前 ) 


如 果 释 放 高 度 ( 释 放 前 ) 一 
一 50mm。 
释放 位 置 ( 释 放 后 ) = 


一 50mm。 


(释放 工件 过 程 ) Z= 工 件 释放 位 置 的 高 度 (在 释放 之 后 ) 
由 于 Y 和 表示 的 是 在 TOOL 坐标 系 中 Z 轴 的 | 
(X, Y, Z, A, B, C) 一 (十 0， 
位 置 ,所 以 这 些 信 E 
位 置 ,所 以 这 些 信号 变量 取决 于 机 器 人 模式 0 
设置 抓 取 工 件 的 加 减速 时 间 比率 。 人 
100% , 则 (X，Y，Z，A，B， 
PAC1 X= 二 加 速 到 工件 位 置 的 倍率 (1%~100%) Pe 和 和 人 下 
YY 一 减速 到 工件 位 置 的 倍率 (1% 一 100%) +0, 0, 十 0) 
设置 抓 取 工 件 的 加 减速 时 间 比 率 。 i 
PAC2 X 一 加 速 到 工件 位 置 的 倍率 (1%% 一 100%) RE 
Y= 减速 到 工件 位 置 的 倍率 (1%~100%) ey 
设置 朝 着 工件 前 进 时 抓 取 工 件 的 加 减速 时 间 | 如 果 设置 加 速 比率 二 50%, 减 
PAC3 比率 。 速 速 比 率 = 80%, 则 (X,Y， 


X 一 加 速 到 工件 位 置 的 倍率 (1%% 一 100%) 
YY 一 减速 到 工件 位 置 的 倍率 (1% 一 100%) 


Z, A, B, C) 一 (十 50, 十 80， 
十 0, 十 0, 十 0, 十 0) 


PAC11 


设置 运动 到 释放 工件 位 置 时 的 加 减速 时 间 比 率 。 
X 一 加 速 到 释放 工件 位 置 的 倍率 (1%% 一 100%) 
Y 一 减速 到 释放 工件 位 置 的 倍率 (1% 一 100%) 


如 果 设 置 加 速 比 率 二 80%, 减 
速 速 比率 一 70% , 则 (X，Y， 
Z, A, B, C) =(+80,+70, 
十 0, 十 0, 十 0, 十 0) 


续 表 


变量 名 称 解 释 设置 样 例 
三 
设置 运动 到 释放 工件 位 置 时 的 加 减速 时 间 比 率 。 tr i a 
PAC12 X 一 加 速 到 释放 工件 位 置 的 倍率 (1%~100%) | ABC 4s ao 
Y 一 减速 到 释放 工件 位 置 的 倍率 (1% 一 100%) Dl 0 0 
当 执行 释放 工件 动作 时 ,设置 朝 工 件 位 置 运动 时 | 如 果 设 置 加 速 比 率 二 100%， 
BA 的 加 减速 时 间 比 率 减速 速 比率 = 100%, 则 (X， 
X= 二 加 速 到 工件 位 置 的 倍率 (1%~100%) Y, 2, A, B, C) = (+ 100, 
Y= 减速 到 工件 位 置 的 倍率 (1%~~100%) 十 100, 十 0, 十 0, 十 0, 十 0) 
如 果 设 置 吸附 时 间 为 为 0. 5 
设置 抓 取 吸 附 时 间 秒 , 则 
X: 抓 取 吸附 时 间 (X, Y, Z, A, B, C) = 
(十 0.5, 十 0, 十 0, 十 0, 十 0, 十 0) 
如 果 设 置 释放 时 间 为 为 0. 3 
设置 释放 时 间 秒 , 则 
a XX: 释放 时 间 (X, Y, Z, A, B, C) = 
(十 0.3, 十 0, 十 0, 十 0, 十 0, 十 0) 
当 抓 取 位 置 改变 后 ,其 差 值 可 以 被 设置 。 用 本 参 
POFSET 数 设置 校正 值 。 本 参数 是 调整 “ 抓 取 点 ”的 重要 
参数 
文 值 (1 一 6) 
设置 值 | 传送 带 位 置 | 传送 带 方向 
PTN 1 前 从 右 到 左 如 果 传 送 带 在 机 器 人 前 方 , 工 
设置 机 器 人 和 传送 带 2 前 从 左 到 右 件 移动 方向 从 右 到 左 , 则 设置 
以 及 工件 移动 方向 的 3 二 从 右 到 左 (X, Y, 2Z, A, B, C) = (+1, 
关系 。 简 称 机 带 关系 4 ee 从 前 到 后 十 0, 十 0, 十 0, 十 0, 十 0) 
右 从 右 到 左 
6 右 从 左 到 右 
设置 追踪 区 范围 (在 该 范围 内 机 器 人 能 够 追踪 工 
件 ) 
Y 一 结束 位 置 
Z 一 临界 位 置 


2. 追踪 区 范围 及 “机 带 关系 ”设置 

(1) 传送 带 在 机 器 人 前 方 ,工件 移动 方向 为 从 右 向 左 , 则 设置 PTN 的 X 坐标 =1; 追踪 
区 范围 PRNG: (X,Y,Z) 王 (十 500, 十 300, 十 400) ,如 图 29-27 所 示 。 

(2) 传送 带 在 机 器 人 前 方 , 工 件 移 动 方向 为 从 左 向 右 , 则 设置 PTN 的 X 坐标 2。 追踪 
区 范围 PRNG: (X,Y,Z) 二 (十 300, 十 100, 十 200) ,如 图 29-28 所 示 。 


(3) 传送 带 在 机 器 人 左 侧 ,工件 移动 方向 为 从 前 向 后 , 则 设置 PTN 的 X 坐标 ==4; 追踪 | 第 
区 范围 PRNG: (X,Y,Z) 二 (十 400, 十 200, 十 300) ,如 图 29-29 所 示 。 29 
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机 器 人 位 置 


工件 移动 方向 


_ 时 > 


图 29-27 机 器 人 追踪 区 域 及 机 带 关系 


布置 图 (PTN 的 X 坐标 =1) 


工件 移动 方向 


29-28 ”机 器 人 追踪 区 域 及 机 带 关系 
布置 图 (PTN 的 X 坐 标 =2) 


(4) 传送 带 在 机 器 人 右 侧 ,工件 移动 方向 为 从 后 向 前 , 则 设置 PTN 的 X 坐标 =5; 追踪 
区 范围 PRNG: (X,Y,Z) 一 (十 500, 十 300, 十 400) ,如 图 29-30 所 示 。 


工件 移动 方向 


600mm 


| 


X=400mm 


| 
| t 
Y=200mm | 


J 300mm| 


图 29-29 


传送 带 机 器 人 
机 器 人 追踪 区 域 及 机 带 关系 
布置 图 (PTN 的 X 坐 标 一 4) 


29.6.3 工 # 程 序 流程 图 
1# 程 序 是 自动 运行 程序 。 以 主 程序 为 框架 ,包含 若干 子 程序 。 主 程序 结构 流程 如 


图 29-31 所 示 ,其 子 程序 如 表 29-4 所 示 。 


工件 移动 方向 


下 Z=400mm 


A 


| 
| 
X=500mm |800mm 
1 


| 


机 器 人 位 置 
图 29-30 机 器 人 追踪 区 域 及 机 带 关系 
布置 图 (PTN 的 X 坐标 一 5) 


表 29-4 子 程序 汇总 表 


序 号 子 程 序 名 称 功 能 
1 回 原点 子 程序 * SSOHOME 回 原点 
2 初始 化 子 程序 S10INIT 进行 初始 化 
3 抓 取 被 追踪 工件 S20TRGET 抓 取 被 追踪 工件 
4 搬运 放置 工件 S30WKPUT 将 工件 放置 在 最 终 位 置 


1. 1# 主 程序 流程 图 
1 井 主 程序 流程 图 如 图 29-31 所 示 。 
2. 回 原点 子 程序 流程 图 


回 原点 子 程序 流程 图 如 图 29-32 所 示 。 
伺服 ON 
获取 当前 位 置 
回 原点 | ES 
1 设置 OVRD=10% 
一 
初始 化 
一 移动 到 待 避 点 
一 一 一 
取出 被 追踪 的 工件 | 设置 OVRD=100% 
放置 工件 
ei 移动 到 原点 
图 29-31 1# 程 序 流程 图 图 29-32 回 原点 程序 流程 图 
回 原点 程序 以 Pl 点 为 原点 (Pl 点 又 作为 “ 待 避 点 ”)。 


(1) 判断 机 器 人 当前 位 置 的 “Z 轴 坐 标高 度 ” 是 否 小 于 Pl1 点 的 “Z 轴 坐 标高 度 ”? 

(2) 如 果 小 于 ,就 直接 升 高 当前 点 到 Pl 点 的 “Z 轴 坐 标高 度 ”。 

(3) 如 果 不 小 于 ,就 直接 指令 回 到 Pl 点 。 

3. 初始 化 子 程序 流程 图 

初始 化 子 程序 流程 图 如 图 29-33 所 示 。 

在 “初始 化 程序 ”中 ,有 一 步 很 重要 ,就 是 “清除 追踪 缓存 区 内 的 数据 *"。 因 为 每 一 次 的 工 
件 视觉 识别 数据 都 被 写 入 “追踪 缓存 区 ”, 而 1# 程 序 是 反复 循环 执行 的 ,所 以 每 执行 完 一 次 
1# 程 序 后 ,再 执行 新 的 程序 前 ,要 将 追踪 区 内 的 数据 清除 ,保证 “追踪 缓存 区 ”内 的 数据 为 最 
新 数据 。 

4. 搬运 放置 工件 子 程序 流程 图 

搬运 放置 工件 子 程序 流程 图 如 图 29-34 所 示 。 

5. 抓 取 被 追踪 的 工件 子 程序 流程 图 


第 
29 
抓 取 工件 程序 流程 图 如 图 29-35 所 示 。 章 
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初始 化 程序 启动 


设置 加 减速 时 间 
倍率 =100% 
设置 OVRD=100% 
1 
选择 最 佳 加 减速 es VES 工件 放置 程序 
Co 到 断 任务 2 是 否 启 启动 
1 NO 
选择 连续 运动 ee i 
tor 由 任务 区 2 让 动 
清除 全 部 输出 信号 设置 ACC 和 DCC 
半 多 部 移入 入 1 和 世人 全 们 和 
1 设置 每 一 任务 区 的 
优先 顺序 
打开 抓 手 吸附 =OFF 
TI 程序 结束 
清除 追踪 缓冲 区 TREE 
本 
尘 Ee 
由 程序 C 1 
获取 modle 数 本 
图 29-33 初始 化 程序 流程 图 图 29-34 搬运 放置 工件 程序 流程 图 


(1) 追踪 动作 各 点 位 ,如 图 29-36 所 示 。 

P500 一 一 待 避 点 /原点 (由 操作 者 设 定 ) 。 

P510 一 一 等 待 点 (由 1 井 程序 中 计算 确定 ) 。 

P520 一 一 追踪 启动 点 (由 1# 程 序 中 计算 确定 )。 

P530 一 一 抓 取 点 (在 C 程序 中 设置 ) 。 

P540 一 一 下 料 摆 放 点 (由 操作 者 示 教 设 定 )。 

(2) 对 各 位 置 点 的 详细 说 明 如 下 。 

Q@ P500 一 一 待 避 点 (由 操作 者 设 定 ), 也 称 为 “机 器 人 原点 ”, 程 序 启动 后 及 追踪 全 部 动 
作 完 成 后 回 到 的 “位 置 点 ”。 

@ P510 一 一 等 待 点 (由 1# 程 序 计算 确定 ), 当 工件 在 “等 待 区 ”时 的 机 器 人 位 置 点 。 
“等 待 点 ”的 意义 就 是 指令 机 器 人 到 达 一 个 最 佳 位 置 ,等待 工 件 进 入 追踪 区 。 在 1# 程 序 中 ， 
以 “ 待 避 点 P1” 为 基准 ,在 X,Z、C 三 个 方向 进行 调整 。 

“等 待 点 "一般 设置 在 X 方向 与 “当前 工件 坐标 ”相同 ,这 是 为 了 减少 追踪 时 的 行程 。 在 
1# 程 序 中 为 PWAIT 点 。 

@ P520 一 一 追踪 启动 点 。 追 踪 启 动 点 是 进入 追踪 模式 后 的 追踪 起 点 (在 1# 程 序 中 由 
TRBASE 指令 设置 ) 。 

@ P530 一 一 抓 料 点 。 这 是 最 重要 的 一 点 。 在 C 程序 中 具体 示 教 确定 ( 设 定 为 全 局 变量 


取出 被 追踪 工件 1 
的 程序 启动 
移动 到 追踪 位 置 上 方 
设置 ACC 及 DCC 
移动 到 吸附 位 置 
1 
移动 到 待 避 点 吸附 =ON 
了 
1 连续 运动 控制 =ON 
从 追踪 数据 区 读数 据 1 
设置 ACC 及 DCC 
1 移动 到 吸附 位 置 的 上 方 
传送 数据 设置 | 
追踪 操作 结束 
ae 
获取 当前 工件 位 置 结束 中 断 监视 
c 伯 位 加 唤 认 | | 人 
ES 设置 ACC 及 DCC=100% 
已 经 越过 
等 待 (1) 区 域 (3) 1 
- 件 位 置 关 
工件 位 置 判断 等 待 flag=0 
1 E 区 . 
设置 ACC 及 DCC 
0 EE 
多 于 全 全 仿生 进入 中 断 监视 
追踪 启动 
等 待 flag=1 


图 29-35 抓 取 工 件 程序 流程 图 
P_100) 。 
P530 抓 料 点 的 设置 应 该 在 靠近 追踪 区 结束 位 置 , 这 样 设置 是 为 了 满足 工件 相隔 距离 较 
小 的 场合 ,在 1# 程 序 中 为 PGT 点 。 


@@ P540 一 一 下 料 摆 放 点 (由 操作 者 示 教 设 定 )。 下 料 摆 放 点 根据 实际 工 况 要求 确 定 ,在 
1# 程 序 中 为 PPT 点。 


6. 传送 数据 子 程序 流程 图 

传送 数据 子 程序 流程 图 如 图 29-37 所 示 。 

7. 1# 程 序 的 运动 流程 及 各 点 位 的 关系 第 
1# 程 序 的 运动 流程 及 各 点 位 的 关系 如 图 29-38 所 示 。 运 动 流程 如 下 。 29 
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Fa 站 


P500 待 避 点 P510 等 待 抓 料 点 


视觉 照相 区 
P540 下 料 摆 放 点 
机 器 人 
图 29-36 ”追踪 动作 各 点 位 示意 图 
设置 迫 踪 基本 数据 
本 追踪 原 点 [ 件 
吸附 位 置 设置 3 如 @ 
一。 视觉 识别 点 
定义 中 断 程序 | | 和 人 PRW 
待 避 点 A 
pt 
PPT 
图 29-37 传送 数据 程序 图 29-38 1# 程 序 各 点 位 示意 图 
流程 图 


(1) 程序 启动 ,机 器 人 运动 到 待 避 点 P1。 

(2) 在 追踪 缓存 区 判断 是 否 有 视觉 数据 (视觉 数据 由 CM1 程序 写 和 人) ,如果 没有 , 则 继 
续 判 断 循环 。 

(3) 如 果 有 ,机 器 人 运动 到 等 待 点 PWAIT。 

(4) 做 当前 工件 位 置 判 断 。 

@ 如 果 在 “等 待 区 ”, 机 器 人 就 一 直 停 在 等 竺 点 PWAIT。 

@ 如 果 进 入 “追踪 区 ”, 机 器 人 就 启动 追踪 模式 。 

(5) 进入 追踪 模式 后 ,移动 到 追踪 原点 PTBASE。 在 1# 程 序 中 ,PTBASE 二 P_100, 即 
追踪 原点 一 抓 取 点 。 

(6) 移动 到 “ 抓 取 点 上 方 ” 一 一 Mov PGT,PUP1. Y Type0 ,0。 

(7) 移动 到 “ 抓 取 点 ”一 一 Mov PGTType0,0。 

(8) 移动 到 * 抓 取 点 上 方 ” 一 -Mov PGT,PUP1.Z Type0,0。 


29. 


(9) 移动 到 “下 料 摆 放 点 PPT”。 
6.4 实用 1# 程 序 


' 提 提 # 主 程序 间 提 提 
< SOOMRIN “' 程 序 分 支 标记 
GoSub x* S90HOME ' 一 一 调 回 原点 子 程序 
GoSub * S10INIT ' 一 一 调 初 始 化 子 程序 
* LOOP" 循环 标志 
GoSub * S20TRGET ' 一 一 调用 抓 取 工件 子 程序 
GoSub * S30WKPUT ' 一 一 调 放置 工件 子 程序 
GoTo * LOOP' 一 一 跳 转 到 * LOOP 行 (反复 执行 以 上 两 个 程序 ) 
End' 一 一 主 程序 结束 。 
'# # 井 井 初始 化 子 程序 # # 井 
* S10INIT 
'/// Speed related /// 设置 速度 倍率 相关 程序 
Accel 100,100 ' 一 一 设置 加 减速 时 间 。 
Ovrd 100 ' 一 一 设置 速度 倍率 。 
LOADSET 1,1 ' 一 一 设置 抓 手 工作 条 件 
0adl 0n' 一 一 启动 最 佳 工作 模式 。 
Cnt 0' 一 一 连续 轨迹 运行 无 效 。 
Clr 1 一 一 输出 点 复位 
HOpen 1 ' 一 一 抓 手 张 开 。 
'/// 初 始 值 设置 /// 
TrClr 1 ' 一 一 对 追踪 缓存 区 1 清 零 (重要 ) 
MWAIT1=0 ' 一 一 对 "工件 到 达标 志 "执行 清 零 。 
'/// 多 任务 启动 (启动 任务 区 2 内 的 程序 "cM1")/// 
M_09# =PWK.X 一 一 设置 工件 类 型 数量 。PWK.X 是 专门 规定 用 于 设置 工件 类 型 数 的 变量 。PWK.X 
为 位 置 变量 形式 ,所 以 必须 在 位 置 变量 区 域 设 置 。 参 见 程序 最 后 部 分 。 
If M_Run(2) = 0 Then ' 一 一 M_Run 为 状态 变量 ,表示 任务 区 内 程序 执行 状态 。M_Run(2) = 0 表示 
任务 区 2 内 的 程序 处 于 停止 状态 。 
XRun 2, "CM1",1 ' 一 一 指令 任务 区 2 内 的 CM1 程序 做 单 次 运行 。 
Wait M_RUN(2) = 1 一 一 等 待 任务 区 2 内 的 程序 启动 
(以 上 是 启动 执行 任务 区 2 内 的 CM1 程序 .) 
EndIf' 一 一 判断 语句 结束 。 
Priority PRI.X,1 “' 一 一 执行 在 任务 区 1 内 的 程序 , 行 数 由 变量 PRI 的 xX 坐标 值 确定 (变量 PRI 
需要 预先 设置 ) 
Priority PRI.Y,2' 一 一 执行 在 任务 区 2 内 的 程序 , 行 数 由 变量 PRI 的 Y 坐 标 值 确定 (变量 PRI 需 
要 预先 设置 ) 
Priority 一 一 多 任务 工作 时 ,指定 各 任务 区 程序 的 执行 行 数 
Return' 一 一 子 程序 结束 。 
'### 抓 取 被 追踪 工件 子 程序 
* S20TRGET' 一 一 程序 分 支 标志 


'/// 追 踪 缓存 区 数据 检查 /// 
* LBFCHK' 一 一 程序 分 支 标志 (检查 追踪 缓存 区 数据 ) 
If M_Trbfct(1)>=1 Then GoTo * LREAD ' 一 一 判断 "追踪 缓存 区 "内 是 否 写 人 视觉 识别 数据 ,如 


果 否 ,就 回 原点 等 待 。 如 果 是 ,就 跳 转 到 * LREAD。 

M_Trbfct 一 一 状态 变量 。 表 示 在 "追踪 缓存 区 内 "的 数据 内 容 。 第 
Mov Pl Type 0,0 ' 一 一 (如 果 NO) 移 动 到 P1 点 。P1 点 是 退 避 点 位 置 。 29 
NNAIT1 = 0 发 出 WAIT1 = 0 信号 ,NWAIT1 是 自 定义 变量 ,表示 机 器 人 处 于 等 待 状态 。 章 
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GoTo * LBFCHK ' 一 一 返回 * LBFCHK 继续 进行 缓存 区 数据 检查 。 

'/// 工 件数 据 采 集 /// 

x* LREAD' 一 一 (如 果 追 踪 缓 存 区 内 有 写 人 的 数据 ,就 从 36 行 跳 转 到 本 行 ) 

TrRd PBPOS, MBENC# ,MBNK % , 1, MBENCNO %S “ 从 "追踪 缓存 区 "读数 据 。 读 出 的 数据 分 别 存 
储 ," 位 置 数据 "存储 在 PBP0S、" 编 码 器 数值 "存储 在 MBENC# 、" 工 件 类 型 数量 "存储 在 MBWK% 、 组 
存 区 序号 = 1, "编码 器 编号 "存储 在 变量 MBENCNO % 。 

GoSub * S40DTSET ' 一 一 调子 程序 * S40DTSET。 * S40DTSET 子 程序 用 于 生成 追踪 起 点 和 抓 取 点 
位 置 。 

'/// 工 件 位置 判 断 /// 

x LNEXT' 程序 分 支 标志 

PX50CUR = TrWcur(MBENCNO % ,PBP0S,MBENC# ) ' 一 一 (获取 当前 工件 位 置 数据 。TrWcur 是 函数 ,用 
于 获得 当前 点 的 编码 器 数值 和 当前 工件 位 置 。 由 于 工件 在 传送 带 上 运行 ,所 以 PX50CUR 是 一 个 
动态 值 ,) 

MBENCNO % 一 一 编码 器 编号 ; 

PBP0S 一 一 视觉 点 位 置 ; 

MBENC# 一 一 编码 器 数值 ; 

PX50CUR 一 一 是 当前 工件 点 的 位 置 ; 

MX50ST = PRNG.X ' 一 一 设置 追踪 区 启动 位 置 线 ; 

MX50ED = PRNG.Y ' 一 一 设置 追踪 区 结束 位 置 线 ; 

MX50PAT = PTN.X ' 一 一 设置 机 - 带 位 置 编号 。PTN 用 于 表示 传送 带 与 机 器 人 的 位 置 关系 。 

GoSub * S50WKPOS' 一 一 调用 确认 工件 位 置 程序 。 

一 一 以 下 是 根据 当前 工件 位 置 进 行 "等 待 "追踪"" 放 弃 "工作 模式 的 选择 。 

If MY50STS = 3 Then GoTo * LBFCHK ' 一 一 MY50STS 是 一 个 变量 , MY50STS 是 工件 当前 位 置 的 判断 
结果 ,如 果 已 经 超出 追踪 区 范围 ,就 跳 转 到 * LBFCHK( 在 35 行 ), 读 取 下 一 工件 信息 。MY50STS = 3 
表示 工件 已 经 超出 机 器 人 工作 范围 
If MY50STS = 2 Then GoTo * LTRST ' 一 一 如 果 MY50STS = 2, 就 跳 转 到 * LTRST, 启动 追踪 程序 (工件 
进入 追踪 区 ) 。 

If MWRIT = 1 Then GoTo * LNEXT ' 一 一 如 果 MWAIT = 1, 就 跳 转 到 * LNEXT, 再 进行 工件 位 置 判 断 。 
'/// 到 等 待 点 PRAIT /// 

PWAIT = Pl ' 一 一 (Pl1:" 待 避 点 ") 把 PHAIT 点 设置 成 为 " 待 避 点 "。 

Select PTN.X ' 一 一 根据 PTN( 机 器 人 与 传送 带 位 置 关系 ) 选 择 程序 流程 ; 

Case 1 TO 2 ' 一 一 如 果 PTN.X= 1 一 2, 则 : 

PWAIT. X= PX50CUR.X ' 一 一 赋值 。 将 当前 工件 点 位 置 的 X 值 赋予 PNAIT.X。 

Case 3 T06 ' 一 一 如 果 PTN.X=3~6, 则 : 

PWAIT.Y= PX50CUR.Y ' 一 一 赋值 。 将 工件 被 检测 点 位 置 的 了 值 赋 予 PWAIT.Y。 

End Select ' 一 一 选择 语句 结束 。 

PHAIT. Z = PX50CUR.Z + PUP1.X' 一 一 

PUP1.X: 待机 高 度 (待机 点 的 高 度 = 当前 工件 点 高 度 + 调整 值 ) 。 


PWAIT.C= PX50CUR. C' 一 一 赋值 。 待 机 位 置 的 C 角度 = 当前 工件 位 置 C 角度 
(以 上 对 待 避 点 设置 完毕 ) 。 
Mov PWAIT Type 0,0 ' 一 一 移动 到 待机 点 PHAIT。 


MWAIT1 = 1 ' 一 一 发 出 机 器 人 到 达 " 等 待 点 "标志 (表示 机 器 人 已 经 到 达 待 机 位 置 。 等 待 工件 进入 
追踪 区 。 以 上 程序 是 设置 一 个 "等 待 点 ", 等 待 点 PWaIT 的 xX、Y 值 与 检测 工件 点 相同 。z 值 比 检测 
点 高 一 个 "调整 量 ",C 值 与 检测 点 相同 ) 。 

GoTo * LNEXT' 一 一 跳 转 回 "工件 位 置 判断 "程序 行 。 

'/// 启 动 追 踪 操作 /// 包 含 追 踪 启 动 指令 ,到 达 吸 附 点 的 动作 。 


< LTRST' 一 一 程序 分 支 标志 (追踪 程序 标志 ) 
Accel PAC1.X, PAC1.Y 一 一 加 减速 时 间 设 置 。 
Cnt 1,0,0 ' 一 一 连续 轨迹 

Act 1=1 一 一 中 断 程序 1 有 效 区 间 起 点 。 


Trk On, PBPOS,MBENC 间 ,PTBRASE,MEBENCNO# ' 一 一 追踪 启动 (包括 移动 到 追踪 起 点 及 追踪 工件 的 动作 ) 


73 ”Mov PGT, PUP1.Y Type 0,0' 一 一 移动 到 抓 取 位 置 PST 上 方 近 点 (PGT 由 " 抓 取 点 + 调节 量 " 构 成 ) 。 
PUP1.Y 为 抓 取 前 位 置 (高 度 ) 
74 ”Accel PAC2.X, PAC2.Y ' 一 一 加 减速 时 间 设 置 。 
75 Mvs PGT ' 移动 到 抓 取 位 置 。 
76 ”HClose 1 ' 一 一 抓 手动 作 。 
77 Dly PDLY1.X ' 一 一 暂停 ,确认 抓 取 。 
PDLY1.X 一 一 预先 设置 的 吸附 时 间 。 
78 Cnt 1 一 一 连续 路 径 
79 ”Accel PAC3.X, PAC3.Y' 一 一 加 减速 时 间 设 置 。 
80 ”Mvs PGT, PUP1.Z 一 一 移动 到 抓 取 ( 完 成 ) 位 置 点 。PUP1.2 为 预 设 的 抓 取 (完成 ) 位 置 点 。 
81 Trk Off ' 一 一 追踪 结束 。 
82 Act 1= 0 ' 一 一 中 断 程序 1 的 有 效 工作 区 间 结 束 点 。 
83 ”Accel 100, 100 一 一 设置 加 减速 时 间 。 
84 MWAIT = 0 一 一 设置 等 待 标志 = 0。 
85 ”Return ' 一 一 子 程序 返回 。 
86 “'### 工 件 摆 放 程序 # # 井 
87 ”x S30WKPUT' 一 一 程序 分 支 标志 。 
88 ”Accel PAC11.X,PAC11.Y ' 一 一 设置 加 减速 时 间 。 
89 ”Mov PPT, PUP2.Y ' 一 一 移动 到 摆 放 位 置 上 部 。PPT 为 摆 放 位 置 。 
90 Accel PAC12.X,PAC12.Y "' 设置 加 减速 时 间 。 
91 Cnt 1, 0, 0' 一 一 连续 轨迹 运行 。 
92 ”Mvs PPT ' 一 一 移动 到 放置 位 置 。 
93 ”HOpen 1 ' 一 一 抓 手 = OFF 。 
94 Dly PDLY2.X ' 一 一 释放 确认 。 
95 Cnt 1 ' 一 一 连续 轨迹 运行 。 
96 Accel PRC13.X,PRC13.Y ' 设置 加 减速 时 间 。 
97 ”Mvs PPT, PUP2.2 ' 一 一 移动 到 放置 位 置 上 点 。 
98 ”Accel 100,100 ' 一 一 设置 加 减速 时 间 。 
99 ”Return ' 一 一 子 程序 返回 。 
100 一 一 追踪 数据 设置 (设置 追踪 起 点 , 抓 取 点 位 置 及 调节 量 )。 
101 x S40DTSET( 生 成 追踪 起 点 、 抓 取 工 作 点 )。 
102 PTBASE = P_100(PWK.X) ' 一 一 生成 追踪 起 点 (P_100 一 一 C 程序 确定 的 抓 取 点 )。 
103 TrBase PTBASE, MBENCNO% ' 一 一 设置 追踪 起 点 (注意 ,这 时 的 追踪 起 点 为 示 教 抓 取 点 P_100) 。 
104 ”PGT = PTBASE x POFSET ' 一 一 设置 抓 取 位 置 (对 抓 取 点 进行 精度 调节 , 注意 是 乘法 运算 )。 
PTBASE 一 一 追踪 起 点 ; 
POFSET 一 一 抓 取 点 调节 量 (主要 用 于 调整 角度 ); 
PGT 一 一 抓 取 位 置 ， 
105 ”GoSub x S46ACSET' 一 一 调用 子 程序 。 
106 Return' 一 一 子 程序 结束 
107 ' 一 一 ## 井 井中 断 程序 1 并 划 
以 下 程序 判断 机 器 人 的 动作 范围 是 否 超过 "追踪 区 临界 距离 "。 如 果 超 出 范围 ,就 结束 追踪 动作 。 
108 x S46ACSET' 一 一 程序 分 支 标志 
109 Select PTN.X ' 一 一 根据 机 - 带 位 置 关 系 选择 动作 ; 
110 Case 1 ' 一 一 如 果 PTN.X=1 
111 MSTP1 = PRNG.Z ' 一 一 设置 "追踪 临界 值 "。PRNG. 2 一 一 追踪 临界 值 ,超过 该 值 就 停止 追踪 。 
112 Def Act 1,P_Fbc(1).Y> MSTP1 GoTo * S91STOP,S ' 一 一 定义 中 断 程序 : 如 果 机 器 人 的 当前 位 置 
(Y 坐标 ) 大 于 "追踪 临界 值 "就 GoTo * S91STOP。 
113 Break' 一 一 结束 选择 语句 "Select PTN. Xx"。 


® 


D 


114 Case 2 ' 一 一 如 果 PTN.X=2。 第 
115 MSTP1 =- PRNG.Z ' 一 一 设置 "追踪 临界 值 "为 - PRNG. 2。 29 
116 Def Act 1,P Fbc(1).Y<MSTP1 GoTo * S91STOP,S 章 
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' 一 一 如 果 机 器 人 的 当前 位 置 (Y 坐标 ) 小 于 "追踪 临界 距离 "就 GoTo * S91STOP 


Break' 一 一 结束 选择 语句 "Select PTN.X" 。 
Case3 如 果 PTN.X=3,， 
Case 5 ' 一 一 如 果 PTN.X=5 
MSTP1 = PRNG. 2 ' 一 一 设置 "追踪 临界 值 "为 PRNG. Z。 
Def Act 1,P Fbc(1).X>MSTP1 GoTo * S91STOP,S 
如 果 机 器 人 的 当前 位 置 (x 坐标 ) 大 于 "追踪 临界 值 "就 GoTo * S91STOP,S 


Break' 一 一 结束 选择 语句 "Select PTN. Xx"。 
Case 4 ' 如 果 PTN.X= 4 
Case 6 . 如 果 PTN.X=6 


MSTP1 =- PRNG. 2' 一 一 设置 "追踪 临界 值 " 为 - PRNG. Z。 
Def Act 1,P_Fbc(1).X<MSTP1 GoTo * S91STOP,S 

判断 : 如 果 机 器 人 的 当前 位 置 (x 坐标 ) 小 于 "追踪 临界 值 "就 GoTo * S91STOP,S 
Break' 一 一 结束 选择 语句 "Select PTN.X" 。 
End Select ' 一 一 结束 选择 语句 "Select PTN. X"。 

Return' 子 程序 结束 。 

' 以 上 程序 用 于 判断 机 器 人 的 动作 范围 是 否 超过 "临界 追踪 值 " 。 
'# ## 确 认 工 件 位 置 程序 间 ##。 
以 下 程序 用 于 判断 工件 是 否 在 工作 区 域 ,判断 以 后 给 出 标志 。 

'PX50CUR' 一 一 当前 工件 位 置 (注意 是 工件 位 置 而 不 是 机 器 人 位 置 ) 

'MX50ST 一 一 追踪 区 启动 线 

'MX50ED 一 一 追踪 区 结束 线 (MX50ED = PRNG.Y) 

'MX50PAT = PTN.X. 一 一 表示 机 器 人 与 传送 带 的 位 置 关系 。 
'MY50STS 一 一 当前 工件 位 置 的 判断 结果 。(MY50STS =1: 工件 在 等 待 区 ; MY50STS = 2: 工件 进入 
追踪 区 ; MY50STS = 3: 工件 已 经 超出 追踪 区 。) 

* S50WKPOS' 一 一 程序 分 支 标志 
MY50STS = 0 ' 一 一 清除 MY50STS 原 结果 数据 。 

Select MX50PRT ' 根据 机 带 位 置 关系 设置 追踪 区 范围 及 判断 工件 当前 位 置 ; 
Case 1 ' 一 一 如 果 PTN.X= 1 

M50STT =- MX50ST ' 一 一 (MX50ST = PRNG.X)MX50ST = 追踪 区 起 点 线 。 
M50END = MX50ED' 一 一 (MX50ED = PRNG.Y)MX50ED = 追踪 区 结束 线 。 

If Poscq(PX50CUR) = 1 And PX50CUR.Y> = M50STT And PX50CUR.Y< = M50END Then 

Poscq 是 检测 "工件 当前 位 置 "是 否 在 机 器 人 工作 范围 的 运算 函数 。 本 行 指令 是 判断 如 
果 " 工 件 当前 位 置 "在 机 器 人 工作 范围 ,而 且 PX50CUR.Y 大 于 追踪 区 起 点 ,PX50CUR.Y 小 于 等 于 追 
踪 区 终点 , 则 

MY50STS = 2 ,一 一 设置 MY50STS = 2 可 进入 追踪 模式 
Else ' 一 一 否则 执行 下 一 行 
If PX50CUR.Y< 0 Then MY50STS = 1 ' 一 一 再 判断 。 工 件 当 前 位 置 Y<0, 则 设置 MY50STS = 1 进入 等 


待 模式 。 
If PX50CUR. Y > M50END Then MY50STS = 3 ' 一 一 再 判断 。 工 件 当前 位 置 Y> M50END, 则 设置 MY50STS 
=3( 工 件 已 经 超出 追踪 范围 ) 。 


If Poscq(PX50CUR) = 0 And PX50CUR.Y> = M50STT And 
PX50CUR.Y< = M50END Then 
MY50STS = 3 ' 一 一 判断 : 如 果 工 件 当 前 位 置 超出 机 器 人 工作 范围 ,也 设置 MY50STS = 3。 表 示 工 件 
已 经 超出 了 动作 区 域 。 
EndIf' 一 一 结束 判断 语句 。 
Break' 一 一 结束 选择 语句 "Select MX50PRT" 。 
Case 2 ' 一 一 如 果 PTN.X= 2 
M50STT = MX50ST' 一 一 设置 追踪 区 起 点 
M50END = 一 MX50ED ' 一 一 设置 追踪 区 终点 。 
If Poscq(PX50CUR) = 1 And PX50CUR.Y< = M50STT And PX50CUR.Y> = M50END Then 
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MY50STS = 2 ' 一 一 可 执行 追踪 。 
Else 一 一 否则 不 能 执行 追踪 。 


If PX50CUR.Y> 0 Then MY50STS = 1 ' 一 一 等 待 。 
If PX50CUR.Y< 0 Then MY50STS = 3 ' 一 一 移动 到 下 一 工件 。 
If Poscq(PX50CUR) = 0 And PX50CUR.Y<= M50STT And PX50CUR.Y> = M50END Then 


MY50STS = 3 ' 一 一 超出 追踪 区 范围 。 


EndIf' 一 一 结束 判断 语句 。 

Break' 结束 选择 语句 "Select MX50PRT" 。 
Case 3 ' 一 一 如 果 PTN.X=3 

Case 5 " 如 果 PTN.X=5 

M50STT =- MX50ST ' 一 一 设置 追踪 区 起 点 。 


65 M50END = MX50ED' 一 一 设置 追踪 区 终点 。 

If Poscq(PX50CUR) = 1 And PX50CUR.X> = M50STT And PX50CUR.X< = M50END Then 
MY50STS = 2 ' 一 一 可 执行 追踪 

Else ' 一 一 如 果 不 能 够 执行 追踪 

If PX50CUR.X< 0 Then MY50STS = 1 ' 一 一 等 待 。 

If PX50CUR.X> 0 Then MY50STS = 3 ' 一 一 移动 到 下 一 工件 。 

If Poscq(PX50CUR) = 0 And PX50CUR. X> = M50STT And PX50CUR. X < = M50END Then 


MY50STS = 3 ' 一 一 超出 追踪 区 范围 。 
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EndIf' 一 一 结束 判断 语句 。 
Break' 一 一 结束 选择 语句 "Select MX50PAT" 。 
Case 4 ' 一 一 如 果 PTN.X= 4 
Case 6 ' 一 一 如 果 PTN.X=6 
M50STT = MX50ST' 一 一 设置 追踪 区 起 点 。 
M50END =- MX50ED ' 一 一 设置 追踪 区 终点 。 
If Poscq(PX50CUR) = 1 And PX50CUR.X< = M50STT And PX50CUR.X> = M50END Then 
MY50STS = 2 ' 一 一 可 执行 追踪 。 
Else ' 一 一 如 果 不 能 执行 追踪 。 
If PX50CUR.X> 0 Then MY50STS = 1 ' 一 一 等 待 。 
If PX50CUR. X< 0 Then MY50STS = 3' 一 一 移动 到 下 一 工件 。 
If Poscq(PX50CUR) = 0 And PX50CUR. X< = M50STT And PX50CUR. X > = M50END Then 
MY50STS = 3 ' 一 一 超出 追踪 区 范围 
EndIf' 一 一 结束 判断 语句 。 
Break' 一 一 结束 选择 语句 "Select MX50PAT" 。 
End Select' 一 一 结束 选择 语句 "Select Mx50PAT"。 
If MY50STS = 0 Then Error 9199' 一 一 报警 而 且 应 该 修正 程序 
Return' 一 一 子 程序 结束 
' 一 一 以 上 程序 根据 机 器 人 与 传送 带 的 位 置 关 系 , 判 断 当前 工件 是 否 在 机 器 人 的 追踪 范围 之 内 。 
从 而 发 出 判断 信号 (等 待 . 可 追踪 .工件 超出 追踪 区 ) 
190“ 一 一 # 井 # 原 回 点 # # 井 (比较 当前 位 置 点 是 否 低 于 "待机 点 高 度 (2)", 如 果 低 于 "待机 点 
高 度 (Z)", 则 直接 提升 到 "待机 点 高 度 (Z)", 如 果 大 于 "待机 点 高 度 (Z)", 则 回 到 Pl 点 。P1 点 既是 


待 避 点 ,也 是 原点 ) 
x* S90HOME' 一 一 程序 分 支 标志 
Servo On ' 伺服 ON。 


P90CURR = P_Fbc(1) ' 一 一 获取 机 器 人 当前 位 置 。 

If P90CURR.Z<P1.2 Then ' 一 一 如 果 当 前 位 置 高 度 低 于 原点 , 则 
Ovrd 10 ' 一 一 设置 速度 倍率 。 

P90ESC = P90CURR ' 一 一 建立 一 个 待机 位 置 

P90ESC.Z= P1.2 ' 一 一 Pl 是 原点 (一 般 也 是 待 避 点 ) 。 
Mvs P90ESC ' 一 一 移动 待 避 点 。 

Ovrd 100 一 一 设置 速度 倍率 。 
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200 EndIf' 一 一 判断 语句 结束 。 
201 Mov P1 ' 一 一 移动 到 原点 
202 Return' 一 一 子 程序 结束 。 
203 “'# 井 井 追 踪 中 断 # 提 井 
' 中 断 程 序 的 内 容 是 : 结束 追踪 模式 ,打开 抓 手 , 回 到 待 避 点 。 
204 ”x S91STOP ' 一 一 程序 分 支 标志 。 
205 ”Act 1 = 0' 一 一 中 断 程序 1 有 效 区 间 终 点 。 


206 Trk Off ' 一 一 结束 追踪 模式 。 
207 HOpen 1 ' 一 一 抓 手 OFF。 
208 P91P=P_Fbc(1) 一 一 设置 P91P 为 当前 点 。 


209 P91P.Z=P1.2' 一 一 设置 P91P 的 2 坐标 为 P1.2( 原 点 高 度 ) 。 

210 Mvs P91P Type 0,0 ' 一 一 升 高 机 器 人 。 

211 Mov Pl ' 一 一 回 到 原点 。 

212 GoTo * LBFCHK' 一 一 跳 转 回 追踪 缓存 区 信息 判断 。 

227 ' 各 位 置 变量 和 调节 变量 的 初始 值 。 
P1: 运行 前 需要 设置 
PAC1 = (100. 000, 100..000,0.000, 0.000, 0.000,0.000,0.000,0.000) (0,0) 
PAC11 = (100. 000, 100. 000, 0. 000, 0.000,0.000,0.000,0.000,0.000)(0,0) 
PAC12 = (100. 000, 100. 000, 0. 000, 0.000,0.000,0.000,0.000,0.000)(0,0) 
PAC13 = (100. 000, 100. 000, 0. 000, 0.000,0.000,0.000,0.000,0.000)(0,0) 
PAC2 = (100.000, 100.000,0. 000, 0.000,0.000,0.000,0.000,0.000)(0,0) 
PAC3 = (100.000, 100.000,0.000, 0.000,0.000,0.000,0.000,0.000)(0,0) 
PDLY1 = (1. 000, 0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PDLY2 = (1. 000, 0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
POFSET = (0.000, 0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PPT = (0.000,0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PRI = (1.000,1.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PRNG = (300. 000,200.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PTN = (1.000,0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PUP1 = (50. 000, - 50.000, - 70.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PUP2 = (0.000, - 50.000, - 50.000,0.000,0.000,0.000,0.000,0.000)(0,0) 
PWK = (1.000,0.000,0.000,0.000,0.000,0.000,0.000,0.000)(0,0) 


29.7 CM1 程序 一 一 追踪 数据 写 入 程序 


本 节 是 对 CM1 程序 进行 解说 。CM1 程序 是 一 个 与 1# 程序 同时 运行 的 程序 .“ 传 送 
带 追 踪 模 式 ” 与 “视觉 追踪 模式 ”的 CM1 程序 是 不 同 的 。 在 不 同 的 模式 下 选用 不 同 的 CM1 
程序 。 


29.7.1 用 于 传送 带 追 踪 的 程序 


CM1 程序 计算 光电 开关 检测 到 的 工件 坐标 ,该 坐标 为 机 器 人 坐标 。 这 一 坐标 数据 由 
“A 程序 ”和 “C 程序 ”获得 。CM1 程序 将 计算 完成 的 数据 写 入 “追踪 缓存 区 ”中 , “追踪 缓 存 
区 ?是 临时 存放 数据 的 区 域 。 

1. 获取 的 数据 

(1) 编码 器 每 一 脉冲 机 器 人 的 移动 量 (P_EncDlt) ; 

(2) 在 “光电 开关 检测 点 ”与 “机 器 人 抓 取 工件 的 位 置 点 ”这 两 点 的 编码 器 数据 之 差 。 


(3) 机 器 人 抓 取 工件 的 位 置 。 

2. 流程 图 

CM1 程序 是 自动 程序 ,放置 在 任务 区 2。 
CMI 程序 流程 图 如 图 29-39 所 示 。 


位 置 数据 写 入 程序 
启动 


检查 光电 开关 


ON 


OFF 


1 
| 获取 编码 器 数 


昌 
将 数据 写 入 
追踪 数据 缓冲 区 


ON 
检查 光电 开关 


OFF 


图 29-39 ”CMI1 程序 流程 图 
3. CM1 程序 


1 ' 林 提 提 提 提 主 程序 林 打 提亲 失 
2 ”x SOOMAIN' 一 一 程序 分 支 标志 


GoSub * S10DTGET ' 一 一 获取 数据 子 程序 

x* LOOP' 一 一 程序 分 支 标志 
GoSub * S20WRITE ' 一 一 工件 位 置 写 人 程序 

GoTo * LOOP' 一 一 跳 转 到 " x LOOP" 行 。 

End' 一 一 主 程序 结束 。 

"# 井 ## 井 获取 数据 程序 # # 井 # 井 井 井 
9 ”* S10DTGET' 一 一 程序 分 支 标志 
16 “ 有 关 抓 取 工件 位 置 数据 编码 器 数值 ,编码 器 编号 已 经 由 C 程序 获得 。 
11 ”MWKNO=M_09# ' 一 一 获取 工件 类 型 数 。 
12 ”M10ED# =M_101# (MWKNO) ' 一 一 编码 器 数值 差 
13 ”MENCNO = P_102(MNKNO) .X ' 一 一 编码 器 编号 
14 ”MSNS=P_102(MWKN0).Y ' 一 一 传感器 序号 
15 一 一 计算 光电 开关 检测 到 的 工件 位 置 (X/Y) 
16 PWPOS=P 100(MWKNO) —P_EncD1t(MENCNO) * M10ED# '—— 
P_100 (MWKNO) 机 器 人 抓 取 工件 位 置 
P_EncD1t(MENCNO) * M10ED# 一 一 从 抓 取 位 置 到 光电 检测 点 的 移动 量 。 
PWP0S 一 一 光电 检测 点 位 置 。 

以 上 是 计算 光电 检测 点 位 置 的 计算 。 

17 ”Return' 一 一 子 程序 结束 。 
18 “' 提 井 井 井 井 位 置 数据 写 人 程序 井 # 井 井 间 并 
19 x S20WRITE' 一 一 程序 分 支 标 志 29 
20 If M_In(MSNS) = 0 Then GoTo * S20WRITE ' 一 一 如 果 光电 开关 未 动作 , 则 继续 等 待 (M_In(MSNS) 是 | 章 
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光电 检测 点 输入 信号 ) ,否则 ( 即 M_In(MSNS) = 1, 光 电 开 关 动 作 ,就 执行 下 一 行动 作 ) 

MENC# =M_Enc(MENCNO) ' 一 一 获取 此 时 的 编码 器 数值 。 

TrWrt PWPOS, MENC 间 ,MWKNO, 1,MENCNO 一 一 关键 就 是 这 一 句 : 将 光电 开关 检测 点 的 数据 写 人 缓存 
区 。 写 入 的 数据 有 : 工件 在 检测 点 的 位 置 .检测 点 的 编码 器 值 .工件 种 类 数 、 缓 存 区 序号 、 编 码 器 
编号 。 

< L20WAIT' 一 一 程序 分 支 标志 

If M_In(MSNS) = 1 Then GoTo * L20WAIT' 一 一 如 果 光 电 开 关 = ON, 就 一 直 在 等 待 。 否 则 结束 子 
程序 。 

Return ' 一 一 子 程序 结束 。 


29.7.2 用 于 视觉 追踪 的 CM1 程序 
1. CM1 程序 中 使 用 的 数据 


CMI 程序 将 视觉 系统 识别 的 工件 位 置 写 入 机 器 人 追 
踪 缓 存 区 。 追 踪 缓 存 区 是 临时 存放 追踪 数据 的 区 域 。 


在 CM1 程序 中 使 用 的 数据 如 下 。 
(1) 编码 器 每 一 脉冲 机 器 人 的 移动 量 (P_EncDlt) 。 


(2) 在 视觉 系统 检测 点 与 机 器 人 位 置 点 这 两 点 的 编 


定义 需要 使 用 的 数组 码 器 数据 之 差 。 
1 (3) 由 视觉 系统 识别 的 工件 位 置 。 
变量 数据 设置 了 程序 (4) 由 视觉 系统 识别 到 的 工件 位 置 点 与 机 器 人 抓 取 
T 点 的 编码 器 数据 之 差 。 
视觉 信息 初始 化 及 (5) 工件 间距 。 
人 (6) 在 传送 带 移动 方向 上 的 视觉 区 域 。 
1 (7) 由 视觉 系统 识别 的 工件 长 度 。 
和 人 2. 1# 程 序 与 CMI 程序 的 关系 
S30CONST 1# 程 序 追 踪 传 送 带 上 的 工件 取决 于 由 CM1 程序 写 
1 入 在 追踪 缓存 区 中 的 工件 信息 。CMI1 程序 将 被 识别 的 工 
计算 编码 器 相关 数据 | 件 位 置 写 入 在 追踪 缓存 区 中 。 被 存储 在 追踪 缓存 区 中 的 
1 信息 由 1# 程 序 读 出 ,机 器 人 根据 这 些 信息 追踪 工件 。 
同 员 遂 人 1# 程 序 与 CM1 程序 的 关系 可 以 简 述 为 ， 
(1) CMI1 程序 将 视觉 系统 识别 的 工件 位 置信 息 写 人 
< “追踪 缓存 区 ”。 
条 汪 中 各 竹下 信守 站 (2) 1# 程 序 读 出 追踪 缓存 区 的 信息 养 据 此 进行 追踪 
环 S40CHKS 工件 。 
员 3. 实用 CMI 程序 
CMI 程序 流程 图 如 图 29-40 所 示 。 
在 以 上 程序 中 ,最 重要 的 是 读数 据 和 写 数据 的 子 


程序 。 
程序 名 为 S40CHKS, 其 程序 流程 图 如 图 29-41 所 示 。 


图 29-40 CMI 程序 流程 图 工件 位 置 与 编码 器 关系 如 图 29-42 所 示 。 


开始 


通过 计算 视觉 区 内 的 编码 器 移动 最 从 
二 而 对 经 过 的 工件 进行 判断 。 如 果 大 于 
ME 和 呈 央 移 动量 | 一 一 一 一 > | 设 定 的 值 ， 表 示 进 来 一 新 工作 ， 就 启 

动 一 次 照相 ， 并 读 写 一 次 数据 。 设 定 
值 称 为 “照相 启动 设 定 值 MEI#* 


编码 器 移动 量 > 照相 启动 


NVTre 一 一 读 编码 器 数据 


EBread 一 一 读 位 置 数 据 
并 处 理 位 置 数据 


做 重心 补偿 数据 
计算 生成 抓 取 点 数据 
(加 重心 补偿 ) 


Trvrt 一 一 将 照相 点 的 数据 
写 和 追踪 缓存 区 


全 部 工件 数据 是 否 写 完 


29-41 ”读数 据 和 写 数 据 的 流程 


当前 点 

编码 器 | 人 
= 

编 运动 方向 
0 
吉 
值 1 

| 1 

t+ 

前 次 点 当前 点 照相 时 间 


图 29-42 工件 位 置 与 编码 器 数据 关系 


圩 吕梁 
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2) 实用 CM1 程序 


1 ”Dim MX(4),MY(4),MT(4),PVS(4) 一 一 定义 需要 使 用 的 数组 。 

2 “' 间 提 提 提 提 主 程序 处 理 提 提 宁 提 提 

3 ”x* S00MAIN' 一 一 程序 分 支 标记 

4 GoSub * S10DTGET “一 一 调用 "数据 获取 处 理 " 子 程序 

5 GoSub * S20VSINI “' 一 一 调用 "视觉 初始 化 处 理 " 子 程序 。 

6 GoSub * S30CONST ”一 一 调用 "条 件 设 定 " 子 程序 。 

| MEP 间 =M_Enc(MENCNO) + MEI# +100 一 一 编码 器 数据 处 理 。 

8 GoSub *S70VOPEN 调用 "视觉 端口 打开 + 视觉 程序 加 载 处 理 " 子 程序 。 
9 ”x*L00_00' 一 一 程序 分 支 标记 

10 ”GoSub * S40CHKS ”' 一 一 调用 "视觉 识别 检查 处 理 " 子 程序 。 

本 GoTo x*L00_00' 一 一 跳 转 到 " * L00_00" 行 

12 ”End' 一 一 主 程序 结束 。 

13 “' 提 提 提 提 间 数据 处 理 一 一 对 要 使 用 的 变量 进行 赋值 间 间 间 ## 
14 ”* S10DTGET' 一 一 程序 分 支 标记 


15 MWKNO=1 ' 一 一 M_09# 机 种 编号 ; 

16 MENCNO = P_102(MWKNO) .Y “一 一 编码 器 编号 ; 

17 MVSL=P_103(MNWKNO) .X 一 一 VS 画面 尺 十 长 边 距离 ; 
18 ”MWKL =P_103(MWKNO) .Y ' 一 一 工件 尺寸 长 边 距 离 ; 
19 ”PTEACH = P_100(MWKNO) ' 一 一 工件 抓 取 点 位 置 ; 

20 ”PVSWRK = P_101(MWKNO) ”一 一 视觉 识别 的 位 置 ; 

21 CCOM$ =C_100$ (MWKNO) ' 一 一 COM 口 编号 ; 

22 CPRG$ =C_101$ (MWKNO) ' 一 一 视觉 程序 名 


23 Return' 一 一 子 程序 结束 
24 ' 提 提 提 提 提 开启 通信 端口 提亲 并 夫 
25 ”x S70VOPEN' 一 一 程序 分 支 标记 


26 NVClose ”一 一 端口 关闭 。 

27 NVOpen CCOMS Rs #1 端口 打开 + 登录 ON。 

28 Wait M_NvOpen(1) =1 “一 一 等 待 端口 连接 完成 。 

29 'NVLoad # 1,CPRG $ 一 一 视觉 程序 加 载 。 

30 Return' 子 程序 结束 

31 “' 井 井 井 ## 视 觉 系统 初始 化 处 理 / 计 算 视 觉 重 心 与 抓 取 中 心 偏差 , 如 果 超 出 设 定 值 就 报警 # # # 井 
井 井 


32 x S20VSINIT' 一 一 程序 分 支 标记 

33 MED1# =M_100# (MENCNO) ' 一 一 M_ 100# = B 程 序 标定 时 传送 带 移动 量 。 
34 PRBORG=P EncDlt(MENCNO) x MED1 # ' 一 一 PRBORG = 视觉 识别 点 位 置 
35 MED2# =M_101# (MNKNO) ' 一 一 M_101# =C 程 序 标定 时 编码 器 移动 量 。 
36 ”PBACK = P_EncD1t(MENCNO) * MED2# ' 一 一 C 程序 理论 抓 取 点 。 


37 ”PWKPOS = PRBORG + PVSWRK + PBACK “一 一 将 视觉 识别 工件 变换 至 机 器 人 区 域 的 位 置 

38 PVTR= (P_Zero/PWKPOS) x PTEACH ' 一 一 视觉 重心 位 置 和 夹 持 位 置 的 向 量 

39 If PVTR.X< 一 PCHK.X Or PVTR.X> PCHK.X Then Error 9110 一 一 追踪 位 置 的 计算 结果 与 理 
论 值 有 较 大 差异 时 报错 。 


40 If PVIR.Y<~ PCHK.Y Or PVTR.Y> PCHK.Y Then Error 9110 
41 Return' 一 一 子 程序 结束 

42 “'# 井 ### 条 件 设 定 /摄像 启动 条 件 计算 # # # 井 井 

43 ”x* S30CONST' 一 一 程序 分 支 标记 


44 MDX=P_EncDlt(MENCNO).Xx 一 一 一 个 脉冲 的 移动 量 (X); 
45 ”MDY= P_EncDlt(MENCNO) .Y ' 一 一 一 个 脉冲 的 移动 量 (Y); 
46 MDZ=P EncDlt(MENCNO).Z 一 个 脉冲 的 移动 量 (2Z); 


47 MD= Sqr(MDX^2+MDY^2+MDZ^2) 一 一 一 个 脉冲 的 向 量 移动 量 计 算 。 


48 
49 
50 
51 
52 
53 
54 
35 
56 
5 


58 
59 
60 
61 
62 
63 


64 
65 
66 
67 
68 
69 
70 
71 
72 
33 
74 
75 
76 
7 
78 
79 
80 
81 
82 
83 
84 
85 
86 
87 
88 
89 
90 
91 
92 
93 
94 
35 
96 


ee] 


MEI# = Abs( (MVSL -MWKL) /MD) ' 一 一 摄像 启动 设 定 值 计算 。 
Return’' 子 程序 结束 
"并 提 并 提 间 视觉 系统 识别 检查 处 理 并 并 并 提 提 
* S40CHKS' 一 一 程序 分 支 标记 
* LVSCMD' 一 一 程序 分 支 标记 
* LWAIT' 一 一 程序 分 支 标记 
MEC# = M_Enc(MENCNO) 一 一 获取 当前 编码 器 值 。 
MEM 井 = MEC# -MEP# 一 一 "当前 编码 器 当前 值 " 减 去 "前 次 编码 器 值 "。 
If MEM#> 800000000.0 井 Then MEM 井 = MEM# 一 1000000000.0# 
If MEM 间 < 一 800000000.0# Then MEM# = MEM# + 1000000000.0# ' 一 一 以 上 是 对 编码 器 数值 
处 理 。 
If hbs(MEM# )> MEI# GoTo * LVSTRG ' 一 一 编码 器 移动 量 和 相机 启动 设 定 值 的 比较 。 
Dly 0.01' 一 一 状态 0.01 秒 
GoTo * LWAIT' 一 一 跳 转 到 " x LWAIT" 行 
* LVSTRG' 一 一 程序 分 支 标记 
MEP# = MEC# “”' 一 一 "编码 器 当前 值 " 写 入 "前 次 值 "。 
NVTrg 并 1,5,MTR1 间 ,MTR2 间 ,MTR3 提 ,MTR4 提 ,MTR5 提 ,MTR6 提 ,MTR7 间 ,MTR8 提 一 一 摄像 要 求 
+ 获取 编码 器 值 。 
一 一 获取 编码 器 值 
If M_NvOpen(1)<>1 Then Error 9100 一 一 通信 和 异常 。 
EBRead 间 1,"", MNUM, PVS1, PVS2, PVS3', PVS4 “一 一 读 取 视觉 系统 数据 。 
pvsll = PVS1 ' 一 一 赋值 计算 。 
PVS(1) = PVSCal(1,pvsl1.X, pvsll.Y,pvsl1.C) ' 一 一 视觉 标定 。 


PVS(1).C= PVS1.C' 一 一 赋值 计算 。 
pvs22 = PVS2 ' 一 一 赋值 计算 。 
PVS(2) = PVSCal(1, pvs22.X, pvs22.Y, pvs22.C) ' 一 一 视觉 标定 。 
PVS(2).C= PVS2.C' 一 一 赋值 计算 。 
pvs33 = PVS3 ' 一 一 赋值 计算 。 
PVS(3) = PVSCal(1, pvs33. X, pvs33.Y, pvs33. C) 一 一 视觉 标定 。 
PVS(3).C= PVS3.C' 一 一 赋值 计算 。 


pvs44 = pvs4 ' 一 一 赋值 计算 。 
pvs(4) = pvscal(1,pvs44.x, pvs44. y, pvs44. c) ' 一 一 视觉 标定 。 

If MNUM = 0 Then GoTo * LVSCMD “一 一 没有 检测 到 工件 时 跳 回 子 程序 起 首 行 。 
If MNUM> 4 Then MNUM = 4 ”一 一 设 工件 数 为 最 大 4 个 。 

For M1 = 1 To MNUM “一 一 循环 次 数 为 识别 个 数 。 
MX(M1) = PVS(M1).X ”一 一 数据 获取 。 

MY(M1) = PVS(M1).Y ' 一 一 数据 获取 。 

MT(M1) = PVS(M1).C 一 一 数据 获取 。 

Next M1 ' 一 一 下 一 循环 。 

GoSub * S60WRDAT 调用 "识别 数据 存储 处 理 " 子 程序 。 


Return' 一 一 子 程序 结束 。 
' 井 井 井 井 井 追 踪 数 据 存储 处 理 井 井 井 井 井 
x* S60WRDAT' 一 一 程序 分 支 标记 
For M1 = 1 To MNUM ' 一 一 处 理 次 数 为 识别 个 数 。 
PSW = P_Zero' 一 一 初始 化 置 零 。 
PSW = PRBORG “一 一 PRBORG 为 "B 程序 确定 的 理论 视觉 点 "。 
PSW.X= PSW.X+ MX(M1) ' 一 一 生成 视觉 识别 位 置 。 
PSW.Y= PSW.Y+ MY(M1) ' 一 一 生成 视觉 识别 位 置 。 
PSW.C= PSW.C- MT(M1) 一 一 生成 视觉 识别 位 置 。 
PRW = P_Zero' 一 一 初始 化 置 零 。 
PVTR.X=- 40' 一 一 赋值 。 
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97 BEVTR.Y=- 72 ,一 一 赋值 。 

98 PFIX=P Zero' 一 一 初始 化 置 零 。 

99 ”PFIX.X=8' 一 一 赋值 。 

100 PPFIX.Y=- 13' 一 一 赋值 。 

101 PVVV = PVTR * PFIX' 一 一 计算 (两 点 乘法 运算 ) 

102 ”PRW= PSW+ PVVV 一 一 最 终 获 得 的 视觉 点 PRW 计算 公式 。 

PRW=B 程序 理论 点 + 视觉 补偿 + 重心 补偿 

103 ”PRW. FL1 =P_100(MWKNO).FL1 一 一 赋值 

104 ”PRW. FL2 =P_100(MWKNO). FL2' 一 一 赋值 

105 ”Select MENCNO ' 一 一 根据 编码 器 编号 选择 执行 不 同 的 写 人 指令 。 

106 Case 1 ' 一 一 MENCNO = 1 

107 TrWrt PRW, MTR1 # 井 ,MNKNO, 1,MENCNO “一 一 ( 写 入 "识别 点 "及 "编码 器 数值 " ) 变 量 依次 为 : 位 
置 ,编码 器 值 ,工件 种 类 编号 ,缓存 编号 , 编码 器 编号 。 

108 ”Break' 一 一 结束 选择 语句 "Select MENCNO" 。 


109 Case 2'——MENCNO=2 
110 TrWrt PRW, MTR2 间 ,MWKNO,1,MENCNO “一 一 位 置 ,编码 器 值 ,机 种 编号 ,缓存 编号 , 编码 器 编号 
111 Break' 一 一 结束 选择 语句 "Select MENCNO" 。 

112 Case 3'——MENCNO=3 

113 TrWrt PRW, MTR3 ## ,MWKNO, 1, MENCNO ' 一 一 位 置 ,编码 器 值 ,机 种 编号 ,缓存 编号 , 编码 器 编号 。 


114 Break' 一 一 结束 选择 语句 "Select MENCNO" 。 

115 Case 4' 一 一 MENCNO = 4 

116 TrWrt PRW, MTR4 间 ,MWKNO,1,MENCNO “一 一 位 置 ,编码 器 值 ,机 种 编号 ,缓存 编号 , 编码 器 编号 
117 ”Break' 一 一 结束 选择 语句 "Select MENCNO" 。 

118 Case 5 ' 一 一 MENCNO = 5 

119 TrWrt PRW, MTR5 # ,MNKNO, 1,MENCNO “一 一 位 置 ,编码 器 值 ,机 种 编号 ,缓存 编号 , 编码 器 编号 
120 Break' 结束 选择 语句 "Select MENCNO" 。 

121 Case 6'——MENCNO=6 

122 TrWrt PRW, MTR6 # ,MWKNO, 1,MENCNO “一 一 位 置 ,编码 器 值 ,机 种 编号 ,缓存 编号 , 编码 器 编号 。 
123 ”Break' 一 一 结束 选择 语句 "Select MENCNO" 。 

124 Case 7' 一 一 MENCNO= 7 

125 。 TrWrt PRW, MTR7 间 ,MWKNO,1,MENCNO “一 一 位 置 ,编码 器 值 ,机 种 编号 ,缓存 编号 , 编码 器 编号 。 
126 Break' 一 一 结束 选择 语句 "Select MENCNO" 。 

127 Case 8'——MENCNO=8 

128 TrWrt PRW, MTR8 间 ,MWKNO, 1,MENCNO ' 一 一 位 置 ,编码 器 值 ,机 种 编号 ,缓存 编号 ,编码 器 编号 。 
129 Break' 结束 选择 语句 "Select MENCNO" 。 

130 ”End Select' 一 一 结束 选择 语句 "Select MENCNO" 。 

131 ”Next M1' 一 一 进入 下 一 循环 。 

132 ”Return' 一 一 子 程序 结束 

133 PVS(1) = (+0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

134 PVS(2) = (+0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 
135 PVS(3) = (+0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 
136 PVS(4) = (+0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

137 PTEACH= (+0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 
138 PCSWRK= (+0.000, + 0.000, + 0.000, + 0.000, +0.000, +0.000, +0.000,+0.000)(0,0) 
139 PRBORG = ( + 0.000, + 0.000, + 0.000, + 0.000, +0.000, + 0.000, +0.000, +0.000)(0,0) 
140 PBACK= ( + 0.000, + 0.000, + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

141 PNKPOS = ( + 0.000, + 0.000, + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 
142 PVTR= ( + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

143 PCHK = ( + 100.000, +100.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 
144 PSW= (+0.000, +0.000, +0.000, +0.000, +0.000, +0.000,+0.000, +0.000)(0,0) 

145 PRW= (+0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 


PVS(1) = ( + 1012. 661, + 648.378, + 0.000, + 0.000, + 0.000, +179.511, + 0.000, +0.000)(0,0) 
PVS(2) = ( + 1012. 661, + 648.378, + 0.000, + 0.000, + 0.000, +179.511, + 0.000, + 0.000)(0,0) 
PVS(3) = ( + 1012. 661, + 648.378, + 0.000, + 0.000, + 0.000, +179.511, + 0.000, + 0.000)(0,0) 
PVS(4) = ( + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(,) 

PTERCH = ( + 670.618, - 41.811, + 217.342, + 0.000, + 0.000, - 74.196, + 0.000, + 0.000)(0,0) 
PVSWRK = ( + 550.148, + 20.165, + 0.000, + 0.000, +0.000, +179.511, + 0.000, +0.000)(0,0) 
PRBORG = ( + 1224.914, + 0.000, + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000)(4,0) 
PBACK = ( — 1070.989, + 0.000, + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000)(4,0) 
PWKPOS = ( + 704.073, + 20.165, + 0.000, + 0.000, +0.000, +179.511, + 0.000, +0.000)(4,0) 
PVIR= ( +32.925, + 62.260, +217.342, + 0.000, + 0.000, +106.293, + 0.000, +0.000)(0,0) 
PCHK = ( + 900. 000, + 800.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

PVS1 = ( + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

PVS2 = ( + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

PVS3 = ( + 0.000, + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

pvs11 = ( +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

pvs22 = ( +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

pvs33 = ( +0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

PSW= ( + 1695.076, - 170.838, + 0.000, + 0.000, +0.000, -10332.774, + 0.000, + 0.000)(4,0) 
PRN= ( +1654.076, - 243.838, + 217.342, + 0.000, + 0.000, - 10226.480, + 0.000, +0.000)(0,0) 
PFIX= (0.000,0.000,0.000,0.000,0.000,0.000,0.000,0.000)(,) 

PVW = (0.000, 0.000,0.000,0.000,0.000,0.000,0.000,0.000)(,) 

PCSWRK = ( + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(,) 

pvs0 = ( + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(0,0) 

PVS4 = ( + 0.000, + 0.000, +0.000, +0.000, +0.000, +0.000, +0.000, +0.000)(,) 


29.8 需要 思考 的 问题 


(1) A 程序 有 什么 功能 ?运行 A 程序 后 得 到 什么 结果 ? 
(2) B 程 序 有 什么 功能 ?运行 B 程序 后 得 到 什么 结果 ? 
(3) C 程序 有 什么 功能 ? 运行 C 程序 后 得 到 什么 结果 ? 
(4) CM 程序 有 什么 功能 ?CM 程序 在 什么 情况 下 运行 ? 
(5) 1# 程 序 有 什么 功能 ? 


第 29 日 一 一 视觉 送 器 程序 的 编制 


第 30 音 第 30 日 机 器 人 编程 软件 
肌 人 时 RT ToolBox 的 学 习 使 用 


【学 习 目的 】 

RT ToolBox2 软件 (以 下 简称 RT) 是 一 款 专门 用 于 三 萎 机 器 人 编程 .参数 设置 .程序 调 
试 .工作 状态 监视 的 软件 。 其 功能 强大 ,编程 方便 。 在 前 面 的 学 习 中 ,已 经 介绍 过 使 用 RT 
软件 设置 参数 ,编制 简短 程序 的 方法 ,本 章 对 RT 软件 的 使 用 做 一 系统 的 介绍 (RT 
ToolBox2 软件 可 以 在 http://cn. mitsubishielectric. com/fa/zh/ 网 站 下 载 )。 


30.1 RT 软件 的 基本 功能 


30.1.1 RT 软件 的 功能 概述 


1. RT 软件 的 5 大 功能 
(1) 编程 及 程序 调试 功能 ; 
(2) 参数 设置 功能 ; 

(3) 备份 还 原 功 能 ; 

(4) 工作 状态 监视 功能 ; 
(5) 维护 功能 。 

2. RT 软件 的 三 种 工作 模式 
(1) 离线 模式 ; 

(2) 在 线 模式 ; 

(3) 模拟 模式 。 


30.1.2 RT 软件 的 功能 一 览 
RT 软件 的 功能 如 表 30-1 所 示 。 

表 30-1 RT 软件 的 基本 功能 

功 能 说 明 


离线 一 一 以 计算 机 中 的 工程 作为 对 象 (不 连接 机 器 人 控制 器 ) 
机 器 人 机 型 名 称 显示 要 使 用 的 机 器 人 机 型 名 称 


程序 编制 程序 


样 条 编制 样 条 曲线 


参数 设置 参数 。 在 与 机 器 人 连接 后 传人 机 器 人 控制 器 


续 表 


功 能 说 明 
在 线 一 一 以 机 器 人 控制 器 中 的 工程 作为 对 象 (连接 机 器 人 控制 器 ) 
程序 编制 程序 
样 条 编制 样 条 曲线 
参数 设置 参数 


在 线 一 一 监视 (监视 机 器 人 工作 状态 ) 


动作 监视 可 以 监视 任务 区 状态 .运行 的 程序 、\ 动 作 状 态 、. 当 前 发 生 报警 
信号 监视 监视 机 器 人 的 输入 输出 信号 状态 

运行 监视 监视 机 器 人 运行 时 间 、 各 个 机 器 人 程序 的 生产 信息 

在 线 一 一 维护 

原点 数据 设 定 机 器 人 的 原点 数据 

初始 化 进行 时 间 设 定 、 程 序 全 部 删除 .电池 剩余 时 间 的 初始 化 ` 机 器 人 的 序列 号 的 设 定 
位 置 恢复 支持 进行 原点 位 置 偏差 的 恢复 

TOOL 长 自动 计算 | 自动 计算 TOOL 长 度 , 设 定 TOOL 参数 

伺服 监视 进行 伺服 电机 工作 状态 的 监视 

密码 设 定 密码 的 登录 /变更 /删除 

文件 管理 能 够 对 机 器 人 遥控 器 内 的 文件 进行 复制 删除 .变更 名 称 
2D Vision 

Calibration 3 视觉 标定 

在 线 一 一 选项 卡 

在 线 一 一 TOOL 

力 觉 控制 

用 户 定义 画面 编辑 

示波器 

模拟 

模拟 完全 模拟 在 线 状态 

节拍 时 间 测 定 

备份 -还 原 

备份 从 机 器 人 控制 器 传送 工程 文件 到 计算 机 

还 原 从 计算 机 传送 工程 文件 到 机 器 人 控制 器 


MELFA 3D-Vision 


能 够 进行 MELFA-3D Vision 的 设 定 和 调整 


30.2 程序 的 编制 调试 管理 


30.2.1 编制 程序 


由 于 使 用 本 软件 有 “离线 "和 “在 线 ” 模 式 , 大 多 数 编程 是 在 离线 模式 下 完成 的 ,在 需要 调 
试 和 验证 程序 时 则 使 用 在 线 模式 。 在 离线 模式 下 编制 完成 的 程序 要 首先 保存 在 计算 机 里 ， 
在 调试 阶段 ,连接 到 机 器 人 控制 器 后 再 选择 在 线 模 式 ,将 编制 完成 的 程序 写 人 “机 器 人 控制 
器 "。 所 以 以 下 叙述 的 程序 编制 等 全 部 为 离线 模式 。 

1. 工作 区 的 建立 

工作 区 就 是 一 个 总 项 目 。 
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工程 就 是 总 项 目 中 每 一 台 机 器 人 的 工作 内 容 ( 程 序 、 参 数 )。 一 个 工作 区 内 可 以 设置 32 
个 工程 ,也 就 是 管理 32 台 机 器 人 。 新 建 一 个 工作 区 的 方法 如 下 。 

(1) 打开 RT 软件 。 

(2) 单 击 “ 工 作 区 ”一 “新 建 ”, 弹 出 如 图 30-1 所 示 的 “工作 区 的 新 建 ”窗口 ,如 图 30-1 所 
示 , 设 置 “工作 区 名 ”和 “标题 ”", 单 击 OK 按钮 。 这 样 ,一 个 新 工作 区 设置 完成 。 同 时 弹出 如 
图 30-2 所 示 的 “工程 编辑 ”对 话 框 。 


标题 名 称 
30-1 “工作 区 的 新 建 ” 窗 口 


2. 工程 的 新 建 

工程 就 是 总 项 目 中 每 一 台 机 器 人 的 工作 内 容 ( 程 序 、 参 数 ), 所 以 需要 设置 的 内 容 如 
图 30-2 所 示 。 

(1) 工程 名 称 ; 

(2) 机 器 人 控制 器 型 号 ; 

(3) 与 计算 机 的 通信 方式 (如 USB、 以 太 网 ); 

(4) 机 器 人 型 号 ; 

(5) 机 器 人 语言 ; 

(6) 行走 台 工 作 参 数 设置 。 

在 一 个 工作 区 内 可 以 设置 32 个 工程 。 如 图 30-3 所 示 ,在 一 个 工作 区 内 设置 了 4 个 工程 。 

3. 程序 的 编辑 

编辑 程序 时 ,菜单 栏 中 会 追加 “文件 ”编辑 ”调试 ”* 工 具 ” 项 目 。 各 项 目 所 含 的 内 容 
如 下 。 

1) “文件 ”菜单 

“文件 ”菜单 所 含 项 目 如 表 30-2 所 示 。 


工程 名 (P): 。 “13 机 器 人 
通信 设 定 (C) 
控制 器。 [CRnD-ZoUGR75xD ~ 


通信 设 定 : 


Send Timeout=5000msec 
Recieve Timeout=30000msec 
Retry=3 


离线 用 机 器 人 设 定 (M) 
机 种 名 : RV-7FD 

机 器 人 语言 : LIMELFA-BASIC V 
显示 用 行走 台 设 定 (B) 
在 此 处 设 定 显示 用 的 行走 台 的 信息 。 
要 更 改行 走 轴 的 动作 范围 的 情况 下 请 交 更 参数 * 


行走 各 : I 


设置 机 器 人 
型 号 和 语言 


30-2 “工程 编辑 ?对话 杠 


由 -好 MELFA-3D Vision 
由 调 1o Simubtor 


图 30-3 一 个 工作 区 内 设置 了 4 个 工程 


表 30-2 “文件 "菜单 


菜单 项 目 (文件 ) 项 目 说 明 
覆盖 保存 以 现 有 程序 覆盖 原 程序 
Ctrl+S 
FE 保存 在 电脑 上 将 编辑 中 的 程序 保存 在 计算 机 
保存 到 机 器 人 上 ()， 
保存 到 机 器 人 上 将 编辑 中 的 程序 保存 到 机 器 人 控制 器 
页 面 设 定 设置 打印 参数 第 
30 
章 
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2)“ 编 辑 ” 菜 单 
“编辑 ”菜单 所 含 项 目 如 表 30-3 所 示 。 
表 30-3 “编辑 ”菜单 


菜单 项 目 (编辑 项 目 说 明 
还 原 撤销 本 操作 
恢复 原 操作 
Se (前 进一步) 
[Emozam_enw mw | 还 原 -位 置 数据 撤销 本 位 置 数据 
可 ” 还 原 (U) ClZ Redo- 位 置 数据 恢复 -位 置 数据 (前 进一步 7 
人 Redo(R) Ctrl+Y ¥ 
A 剪 切 剪 切 选中 的 内 容 
Redo -位置 复制 复制 选中 的 内 容 
¥ mm coax | | 粘贴 把 复制 、 剪 切 的 内 容 粘贴 到 指定 位 置 
国 复制 O Ctrl+C 
局， 粘贴 p) caV 复制 -位 置 数据 对 位 置 数据 进行 复制 
S04 -ma 粘贴 -位 置 数据 对 复制 的 位 置 数据 进行 状态 
粘贴 - 位 置 数据 (A) 
全 cme | | 检索 查找 指定 的 字符 串 
ferrone 从 文件 检索 在 指定 的 文件 中 进行 查找 
葵 换 (E)- Cal+H Es 
人 蔡 换 执行 共 换 操作 
sm 跳 转 到 指定 行 跳 转 到 指定 的 程序 行 号 
人 全 写 入 将 编辑 的 程序 全 部 写 人 机 器 人 控制 器 
El 部 分 写 人 将 编辑 程序 的 选 定 部 分 写 人 机 器 人 控制 器 
goles 选择 行 的 注释 将 选择 的 程序 行 变 为 “注释 行 ” 
命令 行 编 辑 - 在 线 (D) 
语 $ 括 入 -在 (0) 选择 行 的 注释 解除 ”| 将 “注释 行 " 转 为 程序 指令 行 
SE 注释 内 容 的 统一 删除 | 删除 全 部 注释 
命令 行 编辑 -在 线 调试 状态 下 编辑 指令 
命令 行 插入 -在 线 调试 状态 下 插入 指令 
命令 行 删除 -在 线 调试 状态 下 删除 指令 
3)“ 调 试 ”菜单 


“调试 "菜单 所 含 项 目 如 表 30-4 所 示 。 
表 30-4 “调试 "菜单 


菜单 项 目 ( 编 辑 ) 项 目 说 明 
设 定 断 点 设 定单 步 执行 时 的 “停止 行 ” 
解除 断 点 解除 对 “ 断 点 ”的 设置 
解除 全 部 断 点 解除 对 全 部 “ 断 点 ”的 设置 
总 是 显示 执行 行 在 执行 行 显示 光标 


4)“ 工 具 ” 莱 单 
“工具 ”菜单 所 含 项 目 如 表 30-5 所 示 。 


表 30-5 “工具 ”菜单 
菜单 项 目 ( 编 辑 ) 项 目 说 明 
语法 检查 对 编辑 的 程序 进行 “语法 检查 ” 


窗口 (W) 帮助 (H) 


= 指令 模板 提供 标准 指令 格式 供 编程 使 用 
jl 和 直 交 位 置 数据 统一 | 
上 人 对 “ 直 交 位 置 数据 "进行 统一 编辑 

指令 模板 (C)… 

0 2 位 置 数据 统一 | 对 "关节 位 置 数据 "进行 统一 编辑 

关节 位 置 数据 统一 编辑 ()... 

i 时 六 行 运行 国 
et 在 术 和 和 相对 反 的 和 进行 时 
选项 (D)… 
选项 设置 编辑 的 其 他 功能 
4. 新 建 和 打开 程序 
1) 新 建 程序 


在 “工程 树 ” 单 击 “ 程 序 ”>“ 新 建 ”, 弹 出 程序 名 设置 框 。 设 置 程序 名 后 ,弹出 编程 框 如 
图 30-4 所 示 。 

2) 打开 

在 “工程 树 ” 中 单 击 “ 程 序 ”, 弹 出 原 有 排列 程序 框 。 选 择 程 序 名 后 , 单 击 “ 打 开 ”, 弹 出 编 
程 框 如 图 30-4 所 示 。 


由 世 


30-4 ”新 建 及 打开 编程 框 


5. 编程 注意 事项 

(1) 无 须 输入 程序 行 号 ,软件 自动 生成 程序 行 号 。 

(2) 输入 指令 不 区 分 大 小 写字 母 , 软 件 自动 转换 。 

(3) 直 交 位 置 变量 .关节 位 置 变量 在 各 自 编辑 框 内 编辑 ; 位 置 变量 的 名 称 不 区 分 大 小 
写字 母 。 位 置 变 量 在 编辑 时 ,有 “追加 “变更 “删除 ”等 按键 。 

(4) 编辑 中 的 辅助 功能 ,如 剪 切 复制. 粘贴 检索 (查找 ) ,替换 ,与 一 般 软 件 的 使 用 方法 
相同 。 

(5) 位 置 变量 的 统一 编辑 一 一 本 功能 用 于 对 于 大 量 的 位 置 变 量 需 要 统一 修改 某 些 轴 的 
变量 (可 以 加 减 或 直接 修改 ) 的 场合 ,可 用 于 机 械 位 置 发 生 相 对 移动 的 场合 。 单 击 “ 工 具 ”> | 第 
“位 置 变量 统一 变更 ?就 弹出 如 图 30-5 所 示 的 对 话 框 。 30 
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位 二 位 置 变量 


所 有 的 CR 变更 的 数值 】 【选择 变更 形式 ) 
二 


回回 器 口 回 口 回 回 衬 


图 30-5 “位 置 变量 统一 编辑 ”对话 框 


(6) 全 写 人 。 

本 功能 是 将 “当前 程序 ” 写 入 机 器 人 控制 器 中 。 单 击 菜单 “编辑 ”>“ 全 写 和 人 ”。 在 确认 信 
息 显 示 后 , 单 击 “是 ”。 这 是 本 软件 特有 的 功能 。 

(7) 语法 检查 。 

语法 检查 用 于 检查 所 编辑 的 程序 在 语法 上 是 否 正确 。 在 向 控制 器 写 入 程序 前 执行 。 单 
击 菜单 栏 中 的 “工具 ”一 “语法 检查 ”。 在 语法 上 有 错误 的 情况 下 ,会 显示 发 生 错 误 的 程序 行 
和 错误 内 容 , 如 图 30-6 所 示 。 语 法 检查 功能 是 经 常 使 用 的 。 


报警 行 步 马 编 号 报警 内 容 


3Mv ]_Curr,]_Curr+J1, ] Cur+ 了 这 第 ] 拍 2 Syntax < 


ET 区 2 ) (和 


图 30-6 ”语法 检查 报警 框 


(8) 指令 模板 。 

指令 模板 就 是 “标准 的 指令 格式 ”。 如 果 编 程 者 记 不 清楚 程序 指令 ,可 以 使 用 本 功 
能 。 本 功能 可 以 显示 全 部 的 指令 格式 ,只 要 选中 该 指令 双击 后 就 可 以 插入 到 程序 指令 编 
辑 位 置 。 

使 用 方法 : 单 击 菜单 栏 中 的 “工具 ”一 “指令 模板 ”, 弹 出 如 图 30-7 所 示 的 “指令 模板 ”对 
话 框 。 


选择 指令 模板 上 | 


4 


The value of the nput sgnal is returned by the bit sgnal expresson. 现 


单 击 "插入 模板 
[二 入 模板 0 ] [ 关闭 (c) |] 


图 30-7 “指令 模板 ” 对 话 框 


(9) 选择 行 的 注释 /选择 行 的 注释 解除 。 

本 功能 是 将 某 一 程序 行 变 为 "注释 文字 ?或 解除 这 一 操作 。 在 实际 编程 中 ,特别 是 对 于 
使 用 中 文 进行 程序 注释 时 ,可 能 会 一 行 一 行 先 写 中 文 注释 ,最 后 再 写 程序 指令 。 因 此 ,可 以 
先 写 中 文 注 释 , 然 后 使 用 本 功能 将 其 全 部 转 为 “注释 信息 ”。 这 是 简便 的 方法 之 一 。 

在 指令 编辑 区 域 中 ,选中 要 转 为 注释 的 程序 行 , 单 击 菜单 栏 中 的 “编辑 ”>“ 选 择 行 的 注 
释 "”。 选 中 的 行 的 开头 会 加 上 注释 文字 标志 ”””, 变 为 注释 信息 。 另 外 ,选中 需要 解除 注释 的 


行 后 ,再 单 击 菜单 栏 中 的 “编辑 ”~ 


6. 位 置 变量 的 分 类 
位 置 变量 的 编辑 是 最 重要 的 工作 之 一 。 位 置 变量 分 为 直 交 型 变量 和 关节 型 变量 。 在 进 
行 位 置 变量 编辑 时 ,首先 要 分 清 是 “ 直 交 型 变量 ?还 是 "关节 型 变量 ,如 图 30-8 所 示 。 


“选择 行 的 注释 解除 ”, 就 可 以 解除 选择 行 的 注释 。 


0.000 


0.000 


30-8 位 置 变 量 编辑 
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7. 位 置 变量 的 编辑 

首先 区 分 是 位 置 变量 还 是 关节 变量 ,如 果 要 增加 一 个 新 的 位 置 点 , 单 击 “ 追 加 ”按钮 , 弹 
出 “位 置 数 据 的 编辑 ”对 话 框 ,如 图 30-8 所 示 。 在 “位 置 数 据 的 编辑 ”对 话 框 中 需要 设置 以 下 
项 目 。 

1) 设置 变量 名 称 

(1) 直 交 型 变量 设置 为 Pxxx ,注意 以 P 开 头 , 如 Pl1,P2,P10。 

(2) 关节 型 变量 设置 为 Jxxx ,注意 以 J 开头 ,如 1,J2,J10。 

2) 选择 变量 类 型 

选择 是 直 交 型 变量 还 是 关节 型 变量 。 

3) 设置 位 置 变量 的 数据 

设置 位 置 变量 的 数据 有 以 下 两 种 方法 。 

(1) 读 取 当 前 位 置 数 据 一 一 当 使 用 示 教 单元 移动 到 “工作 目标 点 ”后 ,直接 单 击 “ 当 前 位 
置 读 取 ”按钮 ,在 左 侧 的 数据 框 中 立即 自动 显示 “工作 目标 点 ”的 数据 , 单 击 OK 按钮 , 即 设置 
了 当前 的 位 置 点 。 这 是 常用 的 方法 之 一 。 

(2) 直接 设置 数据 一 一 根据 计算 ,直接 将 数据 设置 到 对 应 的 数据 框 中 。 单 击 OK 按钮 ， 
即 设 置 了 位 置 点 数据 。 如 果 能 够 用 计算 方法 计算 运行 轨迹 , 则 用 这 种 方法 。 

4) 数据 修改 

如 果 需 要 修改 “位 置 数据 ”, 操 作 方法 如 下 。 

(1) 选 定 需要 修改 的 数据 。 

(2) 单 击 “ 变 更 ”按钮 ,弹出 如 图 30-9 所 示 “ 位 置 数 据 的 编辑 "对话 框 。 

(3) 修改 位 置 数据 。 

(4) 单 击 OK 按钮 ,数据 修改 完成 。 


设置 变量 名称 | 


选择 变量 类 型 加 下 型 
关节 型 


图 30-9 直接 设置 数据 


5) 数据 删除 

如 果 需 要 删除 位 置 数据 ,操作 方法 如 下 ,如 图 30-8 所 示 。 

(1) 选 定 需要 删除 的 数据 。 

(2) 单 击 “ 删 除 ” 按 钮 , 单 击 YES。 

(3) 数据 删除 完成 。 

8. 编辑 辅助 功能 

单 击 “ 工 具 ” 一 “选项 ”, 弹 出 “选项 ”对 话 框 ,如 图 30-10 所 示 。 该 对 话 框 有 以 下 功能 。 


调整 编辑 


窗口 的 大 小 re 
时 示 领 域 信 ) 
直 交 人 p) 交 是 
进行 保 闻 前 99 下 法 检查 人 65) 
语法 检查 自动 检 相 请 法 
全 语法 检查 前 先 确认 
操 不 出 法 从 查 


自动 获取 器 执行 外 名 位置 交 二 的 保存 雇 入 
当前 位 置 当前 位 村 人 a) 
初始 值 
远 加 由 值 R) C3 取消 


30-10 “选项 ”对 话 框 


(1) 调节 各 分 区 的 大 小 , 即 调节 程序 编辑 框 、 直 交 位 置 数据 编辑 框 、 关 节 位 置 数 据 编辑 
框 的 大 小 。 

(2) 对 编辑 指令 的 语法 检查 进行 设置 ; 对 编辑 指令 的 正确 与 否 进行 自动 检查 ,可 在 写 
入 机 器 人 控制 器 之 前 ,自动 进行 语法 检查 并 提示 。 

(3) 对 “自动 取得 当前 位 置 ”进行 设置 。 

(4) 返回 初始 值 的 设置 ; 如 果 设 置 混乱 后 ,可 以 回 到 初始 值 重新 设置 。 

(5) 对 指令 颜色 的 设置 。 为 视觉 方便 ,对 不 同 的 指令 类 型 、 系 统 函 数 、 系 统 状 态 变 量 标 
以 不 同 的 颜色 。 

(6) 对 字体 类 型 及 大 小 的 设置 。 

(7) 对 背景 颜色 的 设置 。 为 视觉 方便 可 以 对 屏幕 设置 不 同 的 背景 颜色 。 

9. 程序 的 保存 

1) 覆盖 保存 

用 当前 程序 “覆盖 ”原来 的 (同名 ) 程 序 并 保存 。 

单 击 菜单 栏 中 的 “文件 ”一 “覆盖 保存 后 ,进行 覆盖 保存 。 

2) 保存 到 计算 机 

将 当前 程序 保存 到 计算 机 上 。 应 该 将 程序 经 常 保存 到 计算 机 上 ,以免 丢失 。 单 击 菜单 2 
栏 中 的 “文件 ”>“ 保 存在 电脑 上 ”。 章 


第 30 日 一 一 机 器 人 编程 歼 件 RT ToolBox 的 学 习 使 用 


30 日 学 嵌 工 业 机 器 人 


3) 保存 到 机 器 人 

在 计算 机 与 机 器 人 连 线 后 ,将 当前 编辑 的 程序 保存 到 机 器 人 控制 器 。 调 试 完毕 一 个 要 
执行 的 程序 后 当然 是 要 保存 到 机 器 人 控制 器 。 

单 击 菜单 栏 中 的 “文件 ”>“ 保 存在 机 器 人 上 ”。 


30.2.2 程序 的 管理 


1. 程序 管理 

程序 管理 是 指 以 “程序 ”为 对 象 , 对 “程序 ”进行 复制 ,移动 .删除 、 重 新 命名 、 比 较 等 操作 。 
操作 方法 如 下 。 

单 击 “程序 ”~ 程序 管理 ”, 弹 出 如 图 30-11 所 示 的 “程序 管理 ”窗口 。 


30-11 “程序 管理 ”窗口 


“程序 管理 ”窗口 分 为 左右 两 部 分 ,如 图 30-12 所 示 ,左边 为 “传送 源 区 域 ”, 右 边 为 “传送 
目标 区 域 ”。 每 一 区 域内 又 可 以 分 为 : 

(1) “工程 区 域 " 一 一 该 区 域 的 程序 在 计算 机 上 。 

(2) 机 器 人 控制 器 区 域 。 

(3) 存储 在 计算 机 其 他 文件 夹 中 的 程序 。 

选择 某 个 区 域 , 某 个 区 域内 的 “程序 ”就 以 一览 表 ” 的 形式 显示 出 来 。 对 程序 的 复制 移 
动 删除、 重新 命名 、 比 较 等 操作 就 可 以 在 以 上 三 个 区 域内 互相 进行 。 

如 果 左 右 区 域 相同 , 则 可 以 进行 复制 删除、 更名、 比较 操作 ,但 无 法 进行 “移动 ”操作 。 

程序 的 复制 .移动 .删除 、 重 新 命名 、 比 较 等 操作 与 一 般 软 件 相 同 , 根 据 提示 框 就 可 以 
操作 。 

2. 保护 的 设 定 

保护 功能 是 指 对 于 被 保护 的 文件 ,不 允许 进行 移动 删除、 名字 变更 等 操作 。 保 护 功能 
仅 对 机 器 人 控制 器 内 的 程序 有 效 。 

操作 方法 : 选择 要 进行 保护 操作 的 程序 。 能 够 同时 选择 多 个 程序 。 左 右 两 边 的 列表 都 


程序 传送 的 


目标 区 域 
大 小 日 期 名 字 大 小 日 期 
1079 201509/25 16| XFSSG.prg 1079 2015/09125 16| 
287 2015j09/21 16| |XAOCHA... 287 20150921 16| 


空 雁 量 厂 537753394575 [Bytes] 。 空 容量 : 
Snipe (EAR) Me (RAR 


rl wee eee een eee ee 


功能 按键 


图 30-12 程序 管理 的 区 域 及 功能 
能 选择 。 单 击 “ 保 护 ” 按 钮 ,在 “保护 设 定 ”对 话 框 中 设 定 后 ,执行 保护 操作 。 
30.2.3 样 条 曲线 的 编制 和 保存 


1. 编制 样 条 曲线 
右 击 “ 工 程 树 ” 中 的 "在线 ”~“ 样 条 ”, 选 择 “ 新 建 ” 命 令 ,如 图 30-13 所 示 。 


30-13 样 条 曲线 的 编辑 窗口 


由 于 样 条 曲线 是 由 密集 的 “点 ”构成 的 ,所 以 在 如 图 30-13 所 示 的 窗口 中 ,各 “点 ” 按 表格 | 第 
排列 ,通过 单 击 “ 新 行 追加 ”按钮 可 以 追加 新 的 “点 ”。 在 图 30-13 的 右 侧 是 对 “位 置 点 ”的 编 
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辑 框 ,可 以 使 用 示 教 单元 移动 机 器 人 通过 读 取 “ 当 前 位 置 " 获 得 新 的 “位 秆 点 ”, 也 可 以 通过 计 
算 直 接 编辑 位 置 点 。 

2. 保存 

当 样 条 曲线 编制 完成 后 ,需要 保存 该 文件 ,操作 方法 是 单 击 “ 文 件 ”>“ 保 存 ”, 该 样 条 曲 
线 文件 就 被 保存 。 图 30-14 是 “ 样 条 文件 的 保存 ”对 话 框 。 图 30-15 显示 了 已 经 制作 保存 的 
样 条 曲线 名 称 、 数 量 。 


保存 目标 (A): 机 器 人 - 

二 机 器 人 | 
样 条 文件 _- 览 (): ET 
No，| 登录 点 数 | 注释 | ”大 小 | ”日 期 ”| 上 < 
01 4 1.00 KB 2015/12/25 09: 


样 条 曲线 的 编号 广 人 03 
04 


样 条 No.(#): 01 7 


30-14 样 条 曲线 的 保存 


30-15 样 条 曲线 的 显示 


在 加 工程 序 中 使 用 MVSPL 指令 直接 可 以 调用 *x 号 样 条 曲线 。 这 对 于 特殊 运行 轨迹 
的 处 理 是 很 有 帮助 的 。 


30.2.4 程序 的 调试 


1. 进入 调试 状态 
从 工程 树 的 “在 线 ”>“ 程 序 ” 中 选择 程序 , 单 击 鼠 标 右键 ,从 弹出 菜单 中 单 击 “ 调 试 状态 
下 打开 ”, 弹 出 如 图 30-16 所 示 窗 口 。 


在 调试 状态 
下 打开 程序 


On 
Myr ]_Curr]_Curr+Jl ]_Curr+ j2' 第 1 拍 
Myr ]_Curr]_Curr+]3, ]_Curr+ j4' 第 2 拍 
End 


30-16 ”调试 状态 窗口 
2. 调试 状态 下 的 程序 编辑 
调试 状态 下 ,通过 菜单 栏 的 “编辑 ”一 “命令 行 编辑 -在 线 ” 或 “命令 行 插入 -在 线 ” 或 “命令 
行 删除 -在 线 ” 选 项 来 编辑 、 插 入 和 删除 相关 指令 ,如 图 30-17 所 示 。 
位 置 变量 可 以 和 通常 状态 一 样 进行 编辑 。 


ss503E5% 到 


30-17 调试 状态 下 的 程序 编辑 


3. 单 步 执行 

如 图 30-18 所 示 , 单 击 “ 操 作 面板 ”上 的 “前 进 交 后 退 ? 按 键 ,可 以 一 行 一 行 地 执行 程序 。 
“继续 ”执行 是 使 程序 从 “当前 行 " 开 始 执行 。 

4. 操作 面板 上 各 按键 和 显示 器 上 的 功能 

1) 状态 

显示 控制 器 的 任务 区 的 状态 ,显示 “待机 中 ”可 选择 程序 状态 ”。 

2) OVRD 

显示 和 设 定 速度 比率 。 

3) 跳 转 

可 跳 转 到 指定 的 程序 行 号 。 

4) 停止 

停止 程序 。 

5) 单 步 执行 30 

一 行 一 行 执行 指定 的 程序 。 单 击 * 前 进 ” 按 钮 ,执行 当前 行 。 单 击 * 后 退 ? 按 钮 ,执行 上 一 章 
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图 30-18 操作 面板 的 各 调试 按键 功能 


6) 继续 执行 

程序 从 当前 行 开 始 继续 执行 。 

7) 伺服 ON/OFF 

伺服 ON/OFF。 

8) 复位 

复位 当前 程序 及 报警 状态 。 可 选择 新 的 程序 。 

9) 直接 执行 

和 机 器 人 程序 无 关 , 可 以 执行 任意 的 指令 。 

10) 3D 监视 

显示 机 器 人 的 3D 监视 。 

5. 断 点 设置 

在 调试 状态 下 可 以 对 程序 设 定 “ 断 点 ”。 所 谓 “* 断 点 ”功能 是 指 设置 一 个 “停止 位 置 ”, 程 
序 运 行 到 此 位 置 就 停止 。 

在 调试 状态 下 单 步 执行 以 及 连续 执行 时 ,会 在 设 定 的 “ 断 点 程序 行 ”停止 执行 程序 。 停 
止 后 ,再 启动 又 可 以 继续 单 步 执行 。 

断 点 最 多 可 设 定 128 个 ,程序 关闭 后 全 部 解除 。 断 点 有 以 下 两 种 。 

(1) 持续 断 点 : 即便 停止 以 后 , 断 点 仍 被 保存 。 

(2) 临时 断 点 : 停止 后 , 断 点 会 在 停止 的 同时 被 自动 解除 。 

断 点 的 设置 如 图 30-19 所 示 。 

6. 直接 位 置 跳 转 

位 置 跳 转 功能 是 指 选择 某 个 位 置 点 后 直接 运动 到 该 位 置 点 。 

位 置 跳 转 的 操作 方法 如 下 ,如 图 30-20 所 示 。 

(1) (在 有 多 个 机 器 人 的 情况 下 ) 选 择 需要 使 其 动作 的 机 器 人 。 


rvo On 
] Curr]_Curr+]l, ]_Curr+ j2' 第 1 拍 


1|Sse 
2 | Mvr 
3 | Mvr ]_Curr,]_Curr+]3, ]_Curr+ j4' 第 2 拍 
4|End 


30-19 断 点 的 设置 


(2) 选择 移动 方法 (MOV : 关节 插 补 移动 ,MVS: 直线 插 补 移动 ) 。 
(3) 选择 要 移动 的 位 置 点 。 


执行 跳 转 


[inA | med )][ WO | [posure ] [Mov” avaro 
直 交 x Y z A B a uu 已 
pl 0.000 40.000 120.000 0.000 0.000 0.000 0.000 0.000 
0.000 40.000 。 120.000 0.000 0.000 0.000 


30-20 ”位置 跳 转 的 操作 方法 


(4) 单 击 Pos. Jump 按钮 。 

在 实际 使 机 器 人 动作 的 情况 下 ,会 显示 提醒 注意 的 警告 。 

7. 退出 调试 状态 

要 结束 “调试 状态 ”, 单 击 程序 框 中 的 “关闭 ”图 标 即 可 ,如 图 30-21 所 示 。 


单 击 此 处 


Mvr J_Curr,J_Curr+]1, ]_Curr+ j2' 第 1 拍 
Mvr J_Curr,]_Curr+]3, ]_Curr+ j4' 第 2 拍 


30-21 关闭 调试 状态 


30.3 参数 设置 


参数 设置 是 本 软件 的 重要 功能 。 可 以 在 软件 上 或 示 教 单元 上 对 机 器 人 设置 参数 。 各 参 3 
数 的 功能 已 经 在 第 8 章 中 做 了 详细 说 明 ,在 对 参数 有 了 正确 理解 后 用 本 软件 可 以 快速 方便 | 章 


第 30 日 一 一 故 回 人 编程 款 件 RT ToolBox 的 学 习 使 用 


30 日 学 贻 工业 帮 器 人 


地 设置 参数 。 
30.3.1 使 用 参数 一 览 表 


单 击 工程 树 “ 离 线 ”>“ 参 数 ” 一 “参数 一 览 ”, 弹 出 如 图 30-22 所 示 的 “参数 一 览 表 ”。 参 
数 一 览 表 ” 按 参数 的 英文 字母 顺序 排列 ,双击 需要 设置 的 参数 后 ,弹出 该 参数 的 设置 框 ,如 
图 30-23 所 示 ,根据 需要 进行 设置 。 


训 出 DD) 


© 外 


maal value of scceleraton/deceleraton mode{0-Fired value, .Optmum vake) 


:Cyindrical) 
Enable -command, SERVO command and RESET command n MLWAYS siot(o/) 


参数 名 : START 机 器 号 : 0 
说 明 : Al sot Start INPUT,During execute OUTPUT 


打 Eph(P) 入 (W) 关闭 (C) 


图 30-23 参数 设置 框 


使 用 参数 一 览 表 的 好 处 是 可 以 快速 查找 和 设置 参数 ,特别 是 知道 参数 的 英文 名 称 时 可 
以 快速 设置 。 


30.3.2 按 功 能 分 类 设置 参数 


1. 参数 分 类 
为 了 按 同一 类 功能 设置 参数 ,本 软件 还 提供 了 按 参 数 功 能 分 块 设置 的 方法 。 这 种 方法 
很 实用 ,在 实际 调试 设备 时 通常 使 用 这 一 方法 。 本 软件 将 参数 分 为 以 下 几 个 大 类 。 

(1) 动作 参数 ; 

(2) 程序 参数 ; 

(3) 信号 参数 ; 

(4) 通信 参数 ; 

(5) 现场 网 络 参数 。 


每 一 大 类 又 分 为 若干 小 类 。 


2. 动作 参数 
1) 动作 参数 分 类 i 
单 击 “ 动 作 参 数 ”, 展 开 如 图 30-24 所 示 列 表 : 这 是 动作 参 rd 
数 内 的 各 小 分 类 ,根据 需要 选择 。 中国 动作 g 数 
y 各 动作 范围 
2) 设置 具体 参数 晶 灼 
由 - 因 | 抓 手 
操作 方法 如 下 。 国 重 里 和 大 小 
单 击 “ 离 线 ”一 “参数 ”一 “动作 参数 ”一 “动作 范围 ”， 弹 出 og 
如 图 30-25 所 示 的 “动作 范围 设置 " 框 ,在 这 一 “动作 范围 设置 ” 国名 2 
框 内 ,可 以 设置 各 轴 的 "关节 动作 范围 "在 * 直 交 坐 标 系 内 的 动 Bl 
作 范围 "等 内 容 , 既 明确 又 快捷 方便 。 国生 和 
= 和 


单 击 “ 程 序 参数 ”, 展 开 如 图 30-26 所 示 列表 : 这 是 程序 参 。 图 3024 动作 参数 分 类 


数 内 的 各 小 分 类 ,根据 需要 选择 。 


局 


日 国人 未 上 下 村 = | Mr 可 下 RERID 
上 置 2 [动作 参数 的 着 动作 转 0) WEJAR) 。 用户 指定 原点 位置 () (UsERonG)。。 直 交 动作 图 C0 (vePAR) 
中 加 均线 相关 内 容 bh lmmdegl] Ss 
CCD 11: ENN 190.0 1 0.00 X: -10000.00 10000.00 
be J: mm 150.%0 2 0.00 ¥: -10000.00 10000.00 
3 10.00 157,50 3 90.00 Z: -10000.00 10000.00 
14 -200.00 200.00 3 0.00 
35: -120.00 120.00 5 0.00 
% -360.00 350.00 % 0.00 
37: -80000.00 80000.00 7 0.00 
a: -80000.00 ”80000.00 0 


0.00 Esse) CSXQ 


动作 范围 的 
具体 设置 


30-25 设置 具体 参数 


2) 设置 具体 参数 

操作 方法 如 下 。 

单 击 “ 离 线 ” 一 “参数 ”一 “程序 参数 ”>“ 插 槽 表 ”, 弹 出 如 图 30-27 所 示 的 “ 插 槽 表 ”, 在 搬 
槽 表 设 置 框 内 ,可 以 设置 需要 预 运 行 的 程序 。 

4. 信号 参数 

1) 信号 参数 分 类 

单 击 “ 信 号 参数 ”, 展 开 如 图 30-28 所 示 列 表 。 这 是 信号 参数 内 的 各 小 分 类 ,根据 需要 
选择 。 

2) 设置 具体 参数 

操作 方法 如 下 。 30 

单 击 “离线 ”一 “参数 "一 “信号 参数 "一 “专用 输入 输出 信号 分 配 ? 一 “通用 1”, 弹 出 如 | 章 
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， 一 贿 | 输 出 信号 提 位 模式 
” 晶 网 | 专用 输入 输出 信号 分 再 
! 通用 1 


30-28 ”信号 参数 分 类 


图 30-29 所 示 的 “专用 输入 输出 信号 设置 " 框 , 在 “专用 输入 输出 信号 设置 " 框 内 ,可 以 设置 相 
关 的 输入 输出 信号 。 

5. 通信 参数 

1) 通信 参数 分 类 

单 击 “ 通 信人 参数" ,展开 如 图 30-30 所 示 列 表 。 这 是 通信 参数 内 的 各 小 分 类 ,根据 需要 
选择 。 


昌 - 弄 多 数 
SD 20160101-095837 


参数 一 必 [ 本 [ 
中国 人 re | [mE 
启动 START 3 运行 中 START 0 
svt | Se | 0 MM Em 
所 元 专用 输入 输 信号 分 5 。 | 倚 上 SToe ES 一 | Eca 
1 po 
es 号 参 鞠 /” 人 Er EDETEI Er 
单 击 "信号 参数 昌 强 * 报请 页 位 RRESET。。。 2。 | 报 放 生 中 Bes 日 
一 “专用 输入 输出 岂 Jo6 TT | Cae [中 EE 
信和 号 分 配 "一 二 何 最 oFF 1 | 同 on 林 En 
”通用 1” 国 括 时 Sh ET Ez i 
罚 才情 信 上 (名声 ) 。 和 ee = 


-向 | 机 器 锁定 ( 
专用 输入 输出 
信号 设置 杠 
30-29 设置 具体 参数 


白 量 RC1 
日 加 离线 
RV-7FLL-D 
自 俩 程序 
‘日 网 参数 
日 人 20160101-095837 


| 剧 Ethermeti4 定 
同 现场 网 络 参数 


30-30 通信 参数 分 类 


2) 设置 具体 参数 
操作 方法 如 下 。 
单 击 “ 离 线 ” 一 “参数 ”>“ 通 信和 参数 ”一 Ethernet, 弹 出 如 图 30-31 所 示 的 “以 太 网 通信 参 


数 设置 ? 框 ,在 “以 太 网 通信 参数 设置 " 框 内 ,可 以 设置 相关 的 通信 参数 。 


单 击 “ 通 信 参 数 ” 
一 Ethernet 
第 
30 
30-31 设置 具体 通信 参数 章 


第 30 日 一 一 机 器 人 编程 歼 件 RT ToolBox 的 学 习 使 用 


30 日 学 凤 工 业 帮 器 人 


6. 现场 网 络 参数 
单 击 “ 现 场 网 络 参 数 ”", 展 开 如 图 30-32 所 示 列 表 。 这 是 现场 网 络 参 数 内 的 各 小 分 类 , 根 
据 需 要 选择 设置 。 


[本 | 刺 
~ 外 | CC-Link 参 数 设 定 
- 较 PROFIBUS 设 定 
“~ 和 PROFINET 
“入 DeviceNet 
“人 EtherNet/Ip 


图 30-32 现场 网 络 参数 分 类 


30.4 机 器 人 工作 状态 监视 


30.4.1 动作 监视 


1. 任务 区 状态 监视 

监视 对 象 : 任务 区 的 工作 状态 , 即 显 示 任 务 区 (SLOT) 是 否 可 以 写 入 新 的 程序 。 如 果 该 
任务 区 内 的 程序 正在 运行 ,就 不 可 写 入 新 的 程序 。 

单 击 “ 监 视 ” 一 “动作 监视 ”一 “ 插 槽 状态 ”, 弹 出 “ 插 槽 状态 监视 ” 框 。 

“ 插 模 (CSLOT) ”就 是 “任务 区 ”, 如 图 30-33 所 示 。 


No， 括 棒状 态 程序 机 器 启动 条 件 
单 击 " 监 视 ” 一 、】 + 可以 半 所 STRr 
三 ENA 2 可 以 选择 程序 START 
动议 一 | 弛 5 
过 态 ” 4 可 以 选择 程序 START 
一 5 可 以 选择 程序 START 
5 可 以 选择 程序 START 
7 可 以 选择 程序 START 
8 可以 选择 程序 START 


各 任务 区 
工作 状态 


图 30-33 ” 插 槽 状态 监视 框 
2. 程序 监视 
监视 对 象 : 任务 区 内 正在 运行 程序 的 工作 状态 , 即 正在 运行 的 程序 行 。 
单 击 “ 监 视 ”>“ 动 作 监视 ”一 “程序 监视 ”, 弹 出 “程序 监视 ” 框 ,如 图 30-34 所 示 。 


寻 


单 击 "监视 
“程序 监视 
“任务 插 酸 I 让 “任务 插 档 上 内 

正在 运行 的 程序 


图 
回 四 加 
四 这 虹 


四 加 
有 a 
时 


向 应 回 和 
EE 


| 
-入 加 对 


30-34 “程序 监视 ” 框 


3. 动作 状态 监视 

监视 对 象 如 下 。 

(1) 直 交 坐标 系 中 的 当前 位 置 ; 

(2) 关节 坐标 系 中 的 当前 位 置 ; 

(3) 抓 手 ON/OFF 状态 ; 

(4) 当前 速度 ; 

(5) 伺服 ON/OFF 状态 。 

单 击 “ 监 视 ” 一 “动作 监视 ”一 “动作 状态 ”, 弹 出 “动作 状态 ” 框 ,如 图 30-35 所 示 。 


在 直 交 坐标 在 关节 坐标 | 手 状 态 
系 中 的 位 置 系 中 的 位 置 抓 于 愉 态 | 
一 一 wa 一 一 Fer 
当前 位 置 。 。 目的 位 置 当前 位 置 。 ”目的 位 置 
xX] 794.660 508.370 JL 10.350 32.200 。 抓 手 上 + 开 
十 大 和 "一 Y: 145.160 30.10 2 11.700 26.950 。。 抓 手 2: 开 
ee | 114%6.510 1300.250 13: 90.030 90.030 。。 抓 手 3: 开 
了 A: 180.000 -180.000 J]4: -0.000 -0.000 。。 抓 手 4 开 
B:| 11670 25920 5:| 0.000 90.000 。 抓 手 5; | 一 
C:| -169.650 | -147.800 J6: 0.000 0.000 。 捉 手 6: | 一 
0.000 0.000 0.000 0.000 。 抓 手 7 一 
0.000 0.000 0.000 0.000 。 抓 手 8: | 一 
RLE| 7[RAN | 7|RAN 
J114 1518 ]1]4 J5-18 [mm/sed] 
olo 0 | 0 机 器 锁定 状态 : | 。 OFF TEP 速度 :| 。 2436.750 
| ° 二 oo | 
olo 9 [9 伺服 ONoFF: | oN 
[EEREE /A 当前 运行 速度 


伺服 ON/OFF 


30-35 “动作 状态 ” 框 


4. 报警 内 容 监视 
单 击 “ 监 视 ”>“ 动 作 监 视 ”>“ 报 警 ”, 弹 出 “报警 ” 框 , 如 图 30-36 所 示 。 在 “报警 ? 框 内 显 
示 报 警号 ,报警 信息 .报警 时 间 等 内 容 。 
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No。 报警 信息 日 期 时 间 
4340 The varable s not defined 16-01-02 08:20:38 
SS 


了 王 可 单 击 * 监 视 "一 
轿 量 100| “动作 监视 "一 


图 30-36 “报警 ? 框 


30.4.2 信号 监视 


1. 通用 信号 的 监视 和 强制 输入 输出 

功能 : 用 于 监视 输入 输出 信号 的 ON/OFF 状态 。 

单 击 “ 监 视 ” 一 “信号 监视 ”一 “通用 信号 ”, 弹 出 “通用 信号 ”窗口 如 图 30-37 所 示 。 在 “ 通 
用 信号 ”窗口 除了 监视 当前 输入 输出 信号 的 ON/OFF 状态 以 外 ,还 可 以 : 

(1) 模拟 输入 信和 号; 

(2) 设置 监视 信号 的 范围 ; 

(3) 强制 输出 信号 ON/OFF。 


停止 信 
婧 寄存 骂 (cctnk) 
和 运行 监视 


当前 输入 输出 
信号 状态 


少 演 ，。 


图 30-37 “通用 信号 ”窗口 的 监视 状态 


2. 对 已 经 命名 的 输入 输出 信号 监视 

功能 : 用 于 监视 已 经 命名 的 输入 输出 信号 的 ON/OFF 状态 。 

单 击 “ 监 视 ” 一 “信号 监视 ”>“ 带 名 字 的 信和 号”, 弹 出 “ 带 名 字 的 信号 ”窗口 ,如 图 30-38 所 
示 。 在 “ 带 名 字 的 信号 ”窗口 内 可 以 监视 已 经 命名 的 输入 输出 信号 的 ON/OFF 状态 。 

3. 对 停止 信号 以 及 和 急 停 信号 监视 

功能 : 用 于 监视 停止 信号 以 及 急 停 信 号 的 ON/OFF 状态 。 


已 经 命名 的 输入 和 输 
出 信号 监视 框 


图 30-38 “ 带 名 字 的 信号 ”窗口 内 监视 已 经 命名 的 输入 输出 信号 的 ON/OFF 状态 


单 击 “ 监 视 ” 一 “信号 监视 ”一 “停止 信号 ”, 弹 出 “停止 信和 号 ”窗口 如 图 30-39 所 示 。 在 “ 停 
止 信号 ”窗口 内 可 以 监视 停止 信号 以 及 急 停 信号 的 ON/OFF 状态 。 


A 
急 停 信 
ON/OFF 状 态 


30-39 “停止 信号 ”窗口 内 监视 停止 信号 以 及 急 停 信号 的 ON/OFF 状态 


30.4.3 运行 监视 

功能 : 用 于 监视 机 器 人 系统 的 运行 时 间 。 

单 击 “ 监 视 ” 一 “运行 监视 ”>“ 运 行 时间 ”, 弹 出 “运行 时 间 " 窗 口 如 图 30-40 所 示 。 在 “ 运 
行 时 间 ” 窗 口内 可 以 监视 “电源 ON 时 间 ”*“ 运 行 时 间 ”“ 伺 服 ON 时 间 ” 等 内 容 。 


单 击 " 监 视 一 
“运行 监视 "~ 


“运行 时 间 ” 从 晤 信 和 
Nr 
运行 时 间 
| 国生 产 信息 
| 外 国 
昌国 
4 
外 项 备份 
折 畏 TOOL 
MELF; 
日 史 
运行 时 间 
监视 窗口 第 
30 
图 30-40 “运行 时 间 ” 窗 口 章 
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30.5 维 护 


30.5.1 原点 设置 
1. 设置 方式 
功能 : 进行 原点 设置 和 恢复 。 设 置 原点 有 6 种 方式 ,如 图 30-41 所 示 。 
(1) 原点 数据 输入 方式 ; 
(2) 机 械 限 位 器 方式 ; 
(3) 夹具 方式 ; 
(4) ABS 原点 方式 ; 
(5) 用 户 原点 方式 ; 
(6) 原点 参数 备份 方式 。 
单 击 “维护 ” 盖 原点 数据 ,弹出 如 图 30-41 所 示 “ 原 点 数据 ”设置 窗口 。 


日 刁 机 床上 下 料 
30 监 视 
日 侈 RC1 ( 模 所 输入 ) 
离线 


_q 避 用 加 


原点 数据 输入 
的 6 种 方式 


30-41 原点 数据 设置 窗口 


2. 原点 数据 输入 方式 

原点 数据 输入 方式 一 一 直接 输入 “字符 串 ”。 

功能 : 将 出 厂 时 厂家 标定 的 原点 写 入 控制 器 。 出 厂 时 ,厂家 已 经 标定 了 各 轴 的 原点 。 
并 且 作 为 随机 文件 提供 给 使 用 者 。 一 方面 使 用 者 在 使 用 前 应 该 输入 “原点 文件 ”一 一 原点 文 
件 中 每 一 轴 的 原点 是 一 “字符 串 "。 使 用 者 应 该 妥善 保存 “原点 文件 ”。 另 一 方面 ,如 果 原 点 
数据 丢失 后 ,可 以 直接 输入 原点 文件 的 字符 串 ,以 恢复 原点 。 

本 操作 需要 在 联机 状态 下 操作 。 单 击 “ 原 点 数据 输入 方式 ”, 弹 出 如 图 30-42 所 示 “ 原 点 
数据 ” 设 定 窗口 ,各 按钮 作用 如 下 。 

(1) 写 人 一 一 将 设置 完毕 的 数据 写 和 人 控制 器 。 

(2) 保存 文件 一 一 将 当前 原点 数据 保存 到 计算 机 中 。 

(3) 从 文件 读 出 一 一 从 计算 机 中 读 出 “原点 数据 文件 ”。 


原点 数据 写 入 
控制 器 


各 和 的 原点 数 :0 
aa :人 将 原点 数据 保 
有 上 存 到 计算 机 


30-42 ”原点 数据 输入 方式 一 一 直接 输入 “字符 串 ” 


3. 机 械 限 位 器 方式 

功能 : 以 各 轴 机 械 限 位 器 位 置 为 原点 位 置 。 

操作 方法 : 如 图 30-43 所 示 。 

(1) 单 击 原点 数据 画面 中 的 “机 器 限 位 器 方式 ?按钮 ,显示 画面 ; 
(2) 将 机 器 人 移动 到 机 器 限 位 器 位 置 ; 

(3) 选中 需要 做 原点 设 定 的 轴 的 复 选 框 ; 


选择 机 械 限 位 器 


方式 


在 限 位 器 位 置 上 [mm, deg] 
各 轴 的 数据 EE 


图 30-43 机 器 限 位 器 方式 设置 原点 数据 画面 30 
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(4) 单 击 “原点 设 定 ” 按 钮 (原点 设置 完成 ) 。 

图 中 前 一 次 方法 中 ,会 显示 前 一 次 原点 设 定 的 方式 。 

4. 工具 校准 棒 方 式 

功能 : 以 * 校 正 棒 ? 校 正 各 轴 的 位 置 , 并 将 该 位 置 设置 为 原点 。 

操作 方法 : 如 图 30-44 所 示 。 

(1) 单 击 原点 数据 画面 中 的 “夹具 方式 ”按钮 ,显示 画面 如 图 30-44 所 示 ( 夹 具 方 式 就 是 
校正 棒 方 式 ); 

(2) 将 机 器 人 各 轴 移 动 到 “校正 棒 ” 校 正 的 各 轴 位 置 ; 

(3) 选中 需要 做 原点 设 定 的 轴 的 复 选 框 ; 

(4) 单 击 * 原 点 设 定 ” 按 钮 (原点 设置 完成 ) 。 

图 中 前 一 次 方法 中 ,会 显示 前 一 次 原点 设 定 的 方式 。 


单 击 "夹具 方式 ” 


三 各 加 | 
厂 来 及 定 蝇 [ 国 认定 完 
三条 证 因 厂 未定 


30-44 ”夹具 方式 设置 原点 数据 画面 


5. ABS 原点 方式 

功能 : 在 机 器 人 各 轴 位 置 都 有 一 个 三 角 符号 *A”, 将 各 轴 的 三 角 符号 “A” 与 相 邻 轴 的 三 
角 符 号 “A” 对 齐 , 此 时 各 轴 的 位 置 就 是 “原点 位 置 ”。 

操作 方法 : 如 图 30-45 所 示 。 

(1) 单 击 原点 数据 画面 中 的 “ABS 方式 ”按钮 ,显示 画面 如 图 30-45 所 示 ; 

(2) 将 机 器 人 各 轴 移 动 到 三 角 符号 “A” 对 齐 的 位 置 ; 

(3) 选中 需要 做 原点 设 定 的 轴 的 复 选 框 ; 

(4) 单 击 * 原 点 设 定 ?按钮 (原点 设置 完成 ) 。 

图 中 前 一 次 方法 中 ,会 显示 前 一 次 原点 设 定 的 方式 。 

6. 用 户 原点 方式 

功能 : 由 用 户 自行 定义 机 器 人 的 任意 位 置 为 “原点 位 置 。 

操作 方法 如 下 。 


方式 ” 


原点 数据 设置 框 


图 30-45 ABS 方式 设置 原点 数据 画面 


(1) 单 击 原点 数据 画面 中 的 “用 户 原 点 ”按钮 ,显示 画面 类 似 图 30-46; 
(2) 将 机 器 人 各 轴 移 动 到 用 户 任意 定义 的 原点 位 置 ; 
(3) 选中 需要 做 原点 设 定 的 轴 的 复 选 框 ; 


单 击 “ 原 点 设 定 ” 
了 0.00 来 设 定 3 
33 90.00 来 设 定 3 
14 0.00 未 设 定 3 
35 0.00 未 设 定 5 
% 0.00 未 设 定 % 
了 0.00 未 设 定 也 
了 0.00 未 设 定 EE 


30-46 ”用户 原点 方式 设置 原点 数据 画面 


7. 原点 参数 备份 方式 


功能 : 将 原点 参数 备份 到 计算 机 。 也 可 以 将 计算 机 中 的 “原点 数据 ? 写 和 人 到 “控制 器 ”， 
如 图 30-47 所 示 。 


30 
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: -13381810, -7843702, 18999292, 14368118, < 
: 12466, 241526, 137220, 49802, 0, 0, 0, 0 
DJNT : 0.0000, 0.0000, 0.0000, 0.0000, 0.0000, 0.00 


将 文件 中 的 原点 
数据 写 入 控制 器 


30-47 “原点 参数 备份 ”方式 设置 原点 数据 画面 


30.5.2 初始 化 


(1) 功能 : 将 机 器 人 控制 器 中 的 数据 进行 初始 化 。 
可 对 下 列 信息 进行 初始 化 。 

QO@ 时 间 设 定 ; 

@ 所 有 程序 的 初始 化 ; 

@ 电池 剩余 时 间 的 初始 化 ; 

@ 控制 器 的 序列 号 的 确认 设 定 。 

(2) 操作 方法 如 图 30-48 所 示 。 


& 定 ( 设 定时 间 


删除 控制 器 内 程序 


对 电池 时 间 初 始 化 


设 定 机 器 人 序号 


图 30-48 初始 化 操作 框 


30.5.3 维修 信息 预报 


功能 : 将 机 器 人 控制 器 中 的 维 保 信息 数据 进行 提示 预告 。 
可 对 下 列 维 保 信息 进行 提示 预告 。 


(1) 电池 使 用 剩余 时 间 提 示 预 告 ; 
(2) 润滑 油 使 用 剩余 时 间 提 示 预 告 ; 
(3) 皮带 使 用 剩余 时 间 的 提示 预告 
(4) 控制 器 的 序列 号 的 确认 设 定 。 
维 保 信息 框 如 图 30-49 所 示 。 


全 
记 和 这 失信。 用 时 间 


显示 单位 
Sn 3 


Cy] 
mi e+ afiti: 
a 皮带 可 使 
; 二 用 时 间 
润滑 油 可 . 办 ES 
使 用 时 间 = 六 


维护 恬 报 的 结果 是 郑 考 值 。 算 出 的 结果 不 能 保证 一 定 无 误 * 


30-49 维 保 信 息 杠 


30.5.4 位 置 恢复 支持 功能 


如 果 由 于 碰撞 导致 抓 手 变形 或 由 于 更 换 电 机 导致 原点 位 置 发生 偏 差 ,使 用 "位 置 恢复 功 
能 ”, 只 对 机 器 人 程序 中 的 一 部 分 位 置 数据 进行 “再 示 教 "作业 ,就 可 生成 补偿 位 置 偏差 的 参 
数 , 对 控制 器 内 全 部 位 置 数据 进行 补偿 。 


30.5.5 TOOL 长 度 自动 计算 


功能 : 自动 测定 “ 抓 手 长 度 " 的 功能 。 在 实际 安装 了 “ 抓 手 " 后 ,对 一 个 标准 点 进行 3 一 8 
次 的 测定 ,从 而 获得 实际 抓 手 长 度 , 设 置 为 TOOL 参数 (MEXTL)。 


30.5.6 伺服 监视 


功能 : 对 伺服 系统 的 工作 状态 如 电机 电流 等 进行 监视 。 

操作 : 单 击 “维护 ”伺服 监视 ”如 图 30-50 所 示 , 可 以 对 机 器 人 各 轴 伺 服 电机 的 “位 
置 “ 速 度 ”“ 电 流 “ 负 和 载 率 ”进行 监视 。 图 30-50 中 的 画面 是 对 电流 进行 监视 。 这 样 可 以 判 
断 机 器 人 抓 取 的 重量 和 速度 ,加 减速 时 间 是 否 达到 规范 要 求 。 如 果 电 流 过 大 ,就 要 减少 抓 取 
工件 重量 或 延长 加 减速 时 间 。 


30.5.7 密码 设 定 
功能 : 通过 设置 密码 对 机 器 人 控制 器 内 的 程序 .参数 及 文件 进行 保护 。 
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二 二 
于 [二 Sm | me 
六 i | 1 流 监视 窗口 
x 
= 00m i | oo% 1 | oo 
Oc mS 
一人 
EC 加 [ 
和 8 全 天 84 创 RN 这 

[md -/ 电 流 反省 1+ [Ama] wmal 
+ | 0000 加 2 nD mim 于 0.000 
2 [7 SS | | 
= — Ee 
| 一 ， | ms 
四 一 一 三 BE 
se [oo MN | 2 | 20% (| oo 
| 
地 | 000 轩 司 邓 000 。 节 000 四 ro00 


图 30-50 伺服 系统 工作 状态 监视 画面 


30.5.8 文件 管理 
能 够 复制 .删除 、 重 命名 机 器 人 控制 器 内 的 文件 。 
30.5.9 2D 视觉 校准 


1. 功能 

功能 : 2D 视觉 校准 功能 是 标定 视觉 传感器 坐标 系 与 机 器 人 坐标 系 之 间 的 关系 。 可 以 
处 理 8 个 视觉 校准 数据 。 

系统 构成 如 图 30-51 所 示 ,执行 设备 连接 。 


Robot controller 


Ethernet(TCP/IP) Robot 


Q172DRCPU 


三 Windows/RT ToolBox2 


CRnD/CRnQ-700 


| NEE R32TB/R33TB 或 | | 


CR75x-Q/CR75x-D R56TB/R57TB 


Vision sensor j 


图 30-51 2D 视觉 校准 时 的 设备 连接 


2. 2D 视觉 标定 的 操作 程序 
(1) 启动 2D 视觉 标定 ,连接 机 器 人 。 
双击 “在 线 ”>“ 维 护 ”>“2D 视觉 标定 ”。 


(2) 选择 标定 编号 。 mes Cao | ER | 
可 选择 任 一 标定 编号 ,最 大 数 为 8, 如 图 30-52 


所 示 。 30-52 ”选择 标定 序号 
3. 示 教 点 
如 图 30-53 所 示 : 
(1) 单 击 示 教 点 所 在 行 ,移动 光标 ,将 TOOL 中 心 点 定位 到 “标定 点 ”。 


(2) 单 击 Get the robot position 以 获得 机 器 人 当前 位 置 。 

Robot. X 和 Robot. Y 的 数据 将 自动 显示 ,在 Enabled 框 中 自动 进行 检查 。 

(3) 在 单 击 Get the robot position 之 前 ,不 能 编辑 示 教 点 数据 。 

(4) 通过 视觉 传感器 测量 “标定 指示 器 ”的 位 置 。 

分 别 在 (照相 机 X)Camera. X 和 (照相 机 Y)Camera. Y 位 置 输入 X,Y 像素 坐标 。 


Teaching Points: 


Tal 四 0.000:2) 
等 Get therobotposton |14 4 11 /20 pHIxXx 
图 30-53 ”获得 示 教 点 视觉 数据 


如 果 视 觉 传感器 坐标 系 与 机 器 人 坐标 系 的 整合 是 错误 的 或 示 教 点 过 于 靠近 , 则 可 能 出 
现 错误 的 标定 数据 。 

视觉 标定 最 少 需要 4 个 示 教 点 ,如 果 是 精确 标定 则 需要 9 个 点 或 更 多 点 。 分 布 如 
图 30-54 所 示 。 


图 30-54 示 教 点 的 分 布 


4. 计算 视觉 标定 数据 

当 Teaching points 数据 表 中 已 经 有 4 个 点 以 上 时 ,Calculate after selecting 4 points or 
more 按钮 就 变 得 有 效 , 单 击 该 按钮 ,计算 结果 数据 出 现在 Result homography matrix 框 内 ， 
如 图 30-55 所 示 。 

5. 写 人 机 器 人 

单 击 Write to robot 按钮 ,将 计算 获得 的 视觉 传感器 标定 数据 VSCALBn 写 入 控制 器 。 


规 包 洪 
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EEC 
Calibration2 | Calibration3 | Calibration4 | Calibration5 | Calibration6 | Calibration7 | ca 
Roboty CameraX CameraY | 


Enabled 
703.680 庆 | 210.820 庆 | 100.000 上 | 0.000 计 | 
701.650 后 | -203.910 舍 | ”100.000 伟 | 100.000 上 | 


294.340| 拉 | -189.910[ 计 | 0.000 岂 | 100.000 上 | 
289.120[ 全 | 214.4006| 0.000 富 | 0.000 上 | 


器 0.000 全 | 0.000 全 | 0.000 册 | 0.000 风 | 


Boettherobotpostion 114 4 1 /20 .pHIXx 


[Colcate aferselecting 4pomts ormore._| 


Result homography matrix: 
| MI MI2 MI3 MI4 0.1013| 281.051 


M21l M22 M23 I 208.41( 
M1 M32 M33 M34 


Current homography matnx: 
| MIl MI2? MI3 MI4 


Mal M22 Ma3 M24 
M1 M32 M3 M34 


图 30-55 视觉 标定 计算 结果 


6. 保存 数据 
单 击 Save 或 Save as 按钮 保存 示 教 点 和 计算 结果 数据 。 


30.6 备 份 


1. 功能 

将 机 器 人 控制 器 内 的 全 部 信息 备份 到 计算 机 。 

2. 操作 

单 击 “ 在 线 ” 一 “维护 ”>“ 备 份 >“ 全 部 ”, 进 入 全 部 数据 备份 画面 ,如 图 30-56 所 示 。 选 


回程 序 信息 
回 参 数 信息 
回 系 统 程 序 


回 参 数列 表 P) 
由 备份 目标 : 。 D: 戌 的 文档 灿 床 上 下 料 RclBadaupV20160105-105148 。。 诺 照 @j] 


30-56 备份 操作 


30.7 模拟 运行 


30.7.1 选择 模拟 工作 模式 


模拟 运行 能 够 完全 模拟 机 器 人 的 所 有 操作 ,能 够 在 屏幕 上 动态 地 显示 机 器 人 运行 程序 ， 
el 自动 运行 、 直 接 指令 运行 以 及 调试 运行 ,其 功能 很 强大 。 

. 模拟 运行 的 显示 

pi 个 画面 ,如 图 30-57 和 图 30-58 所 示 。 

(1) 模拟 操作 面板 ; 

(2) 3D 运行 显示 屏 。 

由 于 模拟 运行 状态 完全 模拟 了 实际 的 在 线 运行 状态 ,所 以 大 部 分 操作 都 与 “在 线 状态 ” 
相同 。 

2. 模拟 操作 面板 的 操作 功能 

(1) 选择 JOG 运行 模式 。 

(2) 选择 自动 运行 模式 。 


LRC1 模拟 钱 3D 监 视 :RC1 RV-2F-D”[- 品 -加 


[a 和 FJ 
选择 图 号 


操作 面板 
国 到 复位 


程序 | 直接 执行 抓 手 Joc 


| 呈 || 从 | 号 


图 30-57 模拟 操作 面板 图 30-58 3D 运行 显示 屏 


(3) 选择 调试 运行 模式 。 

(4) 选择 直接 运行 。 

3. 模拟 操作 面板 的 监视 功能 

(1) 显示 程序 状态 并 选择 程序 。 

(2) 显示 并 选择 速度 倍率 。 

(3) 显示 运行 程序 。 

4. 在 工具 栏 上 的 图 标 

在 工具 栏 上 的 图 标 其 含义 如 图 30-59 所 示 。 
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伺服 ON 
伺服 OFF 
程序 启动 
程序 停止 
程序 复位 
程序 结束 


30-59 在 工具 条 上 的 图 标 


5. 机 器 人 视点 的 移动 
机 器 人 视图 (3D 监视 ) 的 视点 ,可 以 通过 鼠标 操作 来 变更 。 具 体操 作 如 表 30-6 所 示 。 


表 30-6 机 器 人 (3D 监视 ) 视 点 的 操作 方法 


要 变更 的 视点 上 的 鼠标 操作 

按 住 左 键 的 同时 ,左右 移动 ,Z 轴 为 中 心 的 旋转 

视点 的 旋转 上 下 移动 ,X 轴 为 中 心 的 旋转 
按 住 左 十 右键 的 同时 ,左右 移动 ,Y 轴 为 中 心 的 旋转 

视点 的 移动 按 住 右键 的 同时 ,上 下 左右 移动 

图 形 的 扩大 /缩小 按 住 Shift 键 十 左 键 的 同时 上 下 移动 

30.7.2 自动 运行 
1. 程序 的 选择 


1) 如 果 机 器 人 控制 器 内 有 程序 
在 模拟 操作 面板 上 ,可 以 单 击 “ 程 序 选 择 ”" 图 标 如 图 30-60 所 示 , 弹 出 程序 选择 框 ,如 
图 30-61 所 示 ,选择 程序 , 单 击 OK 按钮 ,就 可 以 选中 程序 。 


| 


程序 行 号 选择 


图 30-60 在 操作 面板 上 单 击 “ 程 序 选择 ” 


图 30-61 在 程序 选择 框 内 选择 程序 


2) 如 果 机 器 人 控制 器 内 没有 程序 

如 果 在 程序 选择 框 内 没有 程序 , 则 需要 将 “离线 状态 ”的 程序 写 人 “在 线 ”, 操 作 与 常规 状 
态 相 同 ,这 样 在 “程序 选择 框 ? 内 就 会 出 现 已 经 写 人 的 程序 ,这 样 就 有 选择 对 象 了 。 

2. 程序 的 启动 /停止 操作 

如 图 30-62 所 示 ,在 模拟 操作 面板 中 ,有 一 “操作 面板 区 ”, 在 “操作 面板 区 ”内 有 “伺服 
ON”“ 伺 服 OFF”“ 启 动 * 复 位 “停止 “结束 ”6 个 按钮 。“ 操 作 面 板 区 ”用 于 执行 “自动 操 
作 ”, 单 击 各 按钮 执行 相应 的 动作 。 


自动 操作 
面板 


图 30-62 程序 的 启动 停止 操作 

30.7.3 程序 的 调试 运行 
在 模拟 状态 下 可 以 执行 调试 运行 。 调 试 运行 的 主要 形式 是 * 单 步 运行 "。 在 模拟 操作 面 | 30 
于 


它 淹 
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板 上 有 单 步 运行 框 ,如 图 30-63 所 示 。 单 步 运 行 框 内 有 “前 进 ”“ 后 退 “ 继 续 ” 三 个 按钮 ,功能 
就 是 单 步 的 前 进 、 后 退 。 与 正常 调试 界面 的 功能 相同 。 


直接 执行 抓 手 JOG 


语 || 人 | 内 


图 30-63 ”调试 功能 单 步 运行 操作 


30.7.4 运行 状态 监视 

在 模拟 操作 面板 上 有 运行 状态 监视 框 ,如 图 30-64 所 示 。 运 行 状态 监视 框 内 有 3D 显示 
选择 .报警 信息 选择 .当前 运行 程序 界面 选择 三 个 按钮 。 单 击 不 同 的 按钮 将 弹出 不 同 的 界 
面 。 图 30-65 是 报警 信息 界面 。 


监视 框 


图 30-64 运行 状态 监视 


| No， 报警 信息 日 其 时 间 级 别 程序 行 “机 器 号 详细 
2602 DSTN pos. exceeds the Imit 15-12-23 16:12:00 Low 42BOLANG 2 


1 260200100 


到 


30-65 ”报警 信息 窗口 


30.7.5 直接 指令 


直接 指令 功能 是 输入 或 选择 某 一 指令 后 ,直接 执行 
该 指令 , 既 不 是 整个 程序 的 运行 ,也 不 是 手动 操作 ,而 是 


自动 运行 的 一 种 形式 ,在 调试 时 会 经 常 使 用 。 使用“ 直 “| 个 开始， 起 包 
Se ENE 
接 运 行 指令 "必须: 人 BOFF 售 止 。 结束 
(1) 已 经 选择 程序 号 。 上 此 | 川 图 图 略 


(2) 移动 位 置 点 必须 是 程序 中 已 经 定义 的 “位 直接 执行 抓 手 。JOG 
置 点 "。 lalsy 

在 模拟 操作 面板 上 单 击 “ 直 接 执 行 ” 图 标 ,如 图 30-66 
和 图 30-67 所 示 。 


图 30-66 ”选择 “直接 执行 ” 


上 机 器 (R): |13RV-2FD 
指令 M): Mw ] Curr cur+]l ] Cur+ 辽 第 ] 拍 加 


历史 (HD): ET 
[Mvr] cur l Cur+J1 ] cur+jz 永 ] 扫 于 
Mwr]_Curr] Cur+]l ] Cur+ 这 第 ] 拍 

Myr J]_-Curr,J_Curr+J1, ] Cur+ 这 第 ] 拍 
Mwr]_Curr] Cur+]1 ]_Cur+ 这 第 ] 拍 
Mwr J_-Curr,]_Curr+]1, J-Curr+ 这 第 ! 拍 
Mwr] CurJ-Curt1 ] Cur+ 这 第 ] 拍 辐 
Mr 1 wr 1 Nr+11 1 Merzi7 第 1 拍 


| 执行 四 关 H 


机 


30-67 “直接 执行 界面 
30.7.6 JOG 操作 功能 
模拟 操作 面板 上 有 JOG 操作 功能 。 单 击 如 图 30-68 所 示 的 JOG 图 标 就 会 弹出 JOG 画 
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面 。 其 操作 与 示 教 单元 类 似 。 
通过 模拟 JOG 操作 ,可 以 更 清楚 地 了 解 各 坐标 系 之 间 的 关系 。 


图 30-68 JOG 操作 界面 


30.8 3D 监视 


3D 监视 是 机 器 人 人 性 化 的 一 个 界面 ,可 以 在 画面 上 监视 机 器 人 的 动作 、 运 动 轨迹 、 各 外 
围 设备 的 相对 位 置 。 
在 离线 状态 下 ,也 可 以 进行 3D 显示 。 当 然 最 好 是 在 模拟 状态 下 进行 3D 显示 。 


30.8.1 机 器 人 显示 选项 


单 击 菜单 上 的 “3D 显示 ”一 “机 器 人 显示 选项 ”, 弹 出 “机 器 人 显示 选项 ”对 话 框 ,如 
图 30-69 所 示 , 本 对 话 框 的 功能 是 选择 显示 什么 内 容 。 

1. 选择 “窗口 ”功能 

弹出 以 下 选项 。 

(1) 是 否 显示 操作 面板 ; 

(2) 是 否 显示 工作 台面 ; 

(3) 是 否 显示 坐标 轴线 ; 

(4) 设置 屏幕 的 背景 色 。 


30-69 “机 器 人 显示 选项 ”对 话 框 


2. 选择 “机 器 人 模型 ” 

弹出 以 下 选项 ,根据 需要 选择 : 

(1) 是 否 显 示 “ 机 器 人 本 体 ”; 

(2) 是 否 显 示 “ 机 器 人 法 兰 轴 (TOOL 坐标 系 坐标 轴 )”; 
(3) 是 否 显示 抓 手 ; 

(4) 是 否 显示 运行 轨迹 。 


3. 样 条 曲线 
显示 样 条 曲线 的 形状 。 
30.8.2 布局 


“布局 ”也 就 是 “布置 图 ”。“ 布 局 ”的 功能 模拟 出 外 围 设备 及 工件 的 大 小 、 位 置 ,同时 模拟 
出 机 器 人 与 外 围 设 备 的 相对 位 置 。 

在 本 节 中 ,有 “零件 "及 “零件 组 ”的 概念 。 既 要 对 每 一 零件 的 属性 进行 编辑 ,也 要 根据 需 
要 把 相关 零件 归于 “同一 组 ”以 方便 更 进一步 制作 “布置 图 ”。 

系统 自 带 矩 形 球形、 圆柱 等 3D 部 件 , 也 可 插入 其 他 文件 中 的 3D 模型 图 。 

单 击 “3D 显示 ”>“ 布 局 ”, 弹 出 “布局 一 览 ” 对 话 框 ,如 图 30-70 所 示 。 

“布局 一 览 ” 对 话 框 中 必须 设置 以 下 内 容 。 

(1) 零件 组 : 指 一 组 零件 ,由 多 个 零件 组 成 。 可 以 统一 对 零件 组 进行 如 移动 .旋转 等 
编辑 。 

(2) 零件 : 某 具 体 的 工件 。 零 件 可 以 编辑 ,如 选择 为 矩形 或 球形 ,设置 零件 大 小 及 在 坐 
标 系 中 的 位 置 。 

在 “布局 一 览 ” 对 话 框 ,选中 要 编辑 的 “零件 ”, 单 击 “ 编 辑 ” 按 钮 ,弹出 如 图 30-71 所 示 “ 布 
局 编辑 "对话 框 ,可 进行 “零件 名称、 组 别 \ 位 置 、 大 小 的 编辑 。 图 30-71 中 编辑 了 一 个 球形 
零件 ,指定 了 球 的 大 小 及 位 置 。 

在 编辑 时 ,可 以 在 3D 视图 中 观察 到 “零件 ”的 位 置 和 大 小 。 
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图 30-70 “布局 一 览 ” 对 话 框 
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图 30-71 零件 的 编辑 与 显示 


30.8.3 抓 手 的 设计 


1. 抓 手 设计 的 功能 

抓 手 是 机 器 人 上 的 附件 。 本 软件 提供 的 抓 手 设 计 功 能 是 一 个 示意 功能 。 抓 手 的 设计 与 
零件 的 设计 相同 。 先 设计 抓 手 的 形状 大 小 ,在 抓 手 设计 画面 中 的 原点 位 置 就 是 机 器 人 法 兰 
中 心 的 位 置 。 

软件 会 自动 将 设计 完成 的 抓 手 连接 在 机 器 人 法 兰 中 心 。 

操作 方法 如 下 。 

(1) 单 击 “3D 显示 ”>“ 抓 手 ” 进 入 抓 手 设计 画面 ; 

(2) 单 击 “ 追 加 ”>“ 新 建 ” 进 入 一 个 新 抓 手 文件 定义 画面 ; 

(3) 单 击 “ 编 辑 ” 进 入 抓 手 的 设计 画面 ; 

-个 抓 手 可 能 由 多 个 零 部 件 构成 ,所 以 一 个 抓 手 也 就 可 以 视 为 一 个 “零件 组 ”。 这 样 抓 
手 的 设计 就 与 零件 组 的 设计 相同 了 。 图 30-71 是 设计 范例 。 


2. 设计 抓 手 的 第 一 个 部 件 

如 图 30-72 所 示 : 

(1) 设置 部 件 名 称 及 组 别 ; 

(2) 设计 部 件 的 形状 和 颜色 ; 

(3) 设置 部 件 在 坐标 系 中 的 位 置 (坐标 系 原点 就 是 法 兰 中心 点 ); 
(4) 设计 部 件 的 大 小 。 

设计 完成 的 部 件 大 小 及 位 置 如 图 30-72 右边 所 示 。 


大 小 (5) mm) 
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图 30-72 抓 手 部 件 11 的 设计 


3. 设计 抓 手 的 第 二 个 部 件 
如 图 30-73 所 示 : 
(1) 设置 部 件 名 称 及 组 别 ; 
(2) 设计 部 件 的 形状 和 颜色 ; 
(3) 部 件 在 坐标 系 中 的 位 置 (坐标 系 原点 就 是 法 兰 中 心 点 ); 
(4) 设计 部 件 的 大 小 。 
设计 完成 的 部 件 大 小 及 位 置 如 图 30-73 右边 所 示 : 第 二 个 部 件 释 加 在 第 一 个 部 件 上 。 
4. 设计 抓 手 的 第 三 个 部 件 
如 图 30-74 所 示 : 
(1) 设置 部 件 名 称 及 组 别 ; 
(2) 设计 部 件 的 形状 和 颜色 ; 
(3) 设置 部 件 在 坐标 系 中 的 位 置 (坐标 系 原点 就 是 法 兰 中 心 点 ); 
(4) 设计 部 件 的 大 小 。 
设计 完成 的 部 件 大 小 及 位 置 如 图 30-74 右边 所 示 : 第 三 个 部 件 又 加 在 第 一 个 部 件 上 。 
这 样 就 构成 了 抓 手 的 形状 。 


将 以 上 文件 保存 完毕 ,再 回 到 监视 画面 , 抓 手 就 连接 在 机 器 人 法 兰 中 心 上 , 如 图 30-75 1 
所 示 。 也 可 以 将 抓 手 设计 成 如 图 30-76 所 示 。 章 
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图 30-73 ” 抓 手 部 件 12 的 设计 
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图 30-74 ” 抓 手 部 件 13 的 设计 


图 30-75 ”设计 安装 完成 的 抓 手 1 图 30-76 设计 安装 完成 的 抓 手 2 


30.9 需要 思考 的 问题 


(1) 如 何 使 用 RT 软件 进行 参数 设置 ? 

(2) 如 何 使 用 RT 软件 获取 示 教 的 位 置 点 ? 

(3) 如 何 使 用 RT 软件 进行 视觉 系统 的 数据 标定 ? 
(4) 如 何 使 用 RT 软件 进行 输入 输出 信号 的 监视 ? 
(5) 如 何 使 用 RT 软件 进行 三 维 模拟 运行 ? 

(6) 如 何 使 用 RT 软件 进行 程序 的 调试 ? 
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